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Abstract 


A  robust  controller  for  the  approach  and  landing 
phase  of  the  Short  Take-off  and  Landing  (STOL)  F-15  is 
developed  via  LQG/LTR  (Linear  System  model.  Quadratic  cost, 
Gaussian  models  of  uncertainty,  used  for  controller 
synthesis,  with  Loop  Transmission  Recovery  techniques  of 
tuning  the  filter  in  the  loop  for  control  robustness 
enhancement)  methods.  Reduced-order  full-state  feedback 
controllers  are  synthesized  using  CGT/PI  (Command  Generator 
Tracking  feedforward  compensator  to  incorporate  handling 
qualities,  with  Proportional  plus  Integral  feedback) 
synthesis,  specifically  using  implicit  model  following  to 
provide  good  robustness  characteristics  in  the  full-state 
feedback  case.  The  robustness  is  fully  assessed  using 
realistic  simulations  of  the  real-world  system  with 
meaningful  deviations  from  design  conditions.  Once  a 
Kalman  filter  is  embedded  into  the  loop  to  estimate  states 
rather  than  assuming  artificial  access  to  all  states,  LTR 
methodology  is  used  to  preserve  as  much  robustness  as 
possible.  A  full  assessment  of  performance  and  robustness 
of  these  final  implementable  designs  is  provided. 


i 
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Aircraft  flight  control  laws  Must  be  designed  so 
that  the  aircraft  will  achieve  satisfactory  response  not 
only  to  design  conditions,  but  also  to  real-world 
situations.  The  differences  between  the  real-world 
conditions  and  the  Mathematical  model  used  in  the 
development  of  the  controller  stem  from  the  fact  that  there 
are  not  really  nth-order  systems  in  nature,  only  nth-order 
models  of  physical  phenomena.  The  controller  is  usually 
designed  from  a  model  of  reduced  order  from  the  original 
system  model  and,  in  general.  Ignores  nonl lnearltles.  Once 
designed,  the  controller  will  face  unmodelled  disturbances 
on  the  system  and  variations  in  the  parameters  of  the 
system  from  the  design  conditions.  A  controller  that,  in 
the  face  of  the  above  conditions,  yields  a  closed-loop 
system  that  is  stable  and  retains  some  measure  of 
performance,  is  termed  a  robust  controller.  This  is  one  of 
the  main  goals  in  flight  control  design. 

Currently  there  are  several  approaches  that  are  in 
use  in  control  design.  Many  use  time-domain  techniques, 
which  call  for  a  system  modelled  as  linear  and  manipulated 


under  linear  system  theory  to  develop  control  laws  to  be 
implemented  on  a  digital  computer  [1,3,8,271.  Other 
approaches  invoke  the  frequency-  domain  theory  of  classical 
control  techniques  and  the  benefit  of  readily  understood 
graphical  stability  analysis  [7,8,131.  The  design  method 
employed  in  this  thesis  combines  the  ease  of  Implementation 
of  the  time  domain  techniques  with  the  availability  of 
stability  and  stability  robustness  insights  of  frequency 
domain  techniques. 

This  method  assumes  that  the  system  to  be  controlled 
can  be  modelled  as  a  linear  system  that  may  have  dynamics 
disturbances  or  measurement  corruptions  represented  as 
Gaussian  processes,  with  a  scalar  quadratic  cost  function 
to  be  minimized  for  controller  synthesis  and  is  known  as 
Linear-Quadrat ic-Gauss lan  (LQG)  design  (201.  The 
controller  to  be  designed  will  be  a  Command  Generator 
Tracker  <CGT>  which  provides  feedforward  control,  a 
Proportional  plus  Integral  <PI>  controller  to  provide 
feedback  control,  and  a  Kalman  Filter  to  estimate  the 
states  in  the  face  of  Incomplete /noise-corrupted 
measurements.  The  PI  controller  will  be  developed  using 
implicit  model  following  control  techniques,  so  that  it 
will  be  as  robust  as  possible  [24).  The  Kalman  filter, 
which  has  a  negative  effect  on  the  robustness  of  the 
controller,  is  then  tuned  using  Loop  Transfer  Recovery 
procedures  [9,10,15,281  to  recover  as  much  of  the  robustness 


2 


of  the  corresponding  full-state  feedback  controller  as 
possible . 

1-2  Problem 

The  purpose  of  this  study  Is  to  develop  a  robust 
flight  controller  for  the  approach  and  landing  phase  for 
the  Short  Takeoff  and  Landing  (STOL)  F-15.  This  digital 
controller  is  designed  using  LQG  design  techniques  with  the 
CGT/PI/KF  control  laws  developed  with  implicit  model 
following  to  enhance  robustness  and  LTR  techniques  used  to 
attempt  to  recover  robustness  lost  to  the  Kalman  filter.  It 
is  required  that  the  controller,  and  thus  the  aircraft,  be 
stable  and  maintain  a  minimum  level  of  performance  in  the 
face  of  large  parameter  variations,  such  as  those  occurring 
from  off-design  operation;  actuator  failure;  actuator 
saturations;  or  mlsmodelled  actuator  dynamics,  either  from 
errors  in  the  model  or  from  the  reduction  in  order  for  the 
simplification  of  the  mathematical  model. 

This  study  has  been  done  concurrently  with  efforts 
using  other  control  design  methods  for  the  same  flight 
arena  11,71  and  with  studies  using  this  method  and  one 
other  for  up  and  away  flight  manuevers  114,271.  While  It 
is  inevitable  that  comparisons  between  the  merits  of  the 
various  methods  will  be  made,  the  primary  goal  of  this 
research  is  not  to  prove  which  method  is  superior,  but  to 
exploit  and  enhance  controller  design  methodology. 


1-3  Scope 

This  thesis  effort  will  design  and  analyze  a 
CGT/PI/KF  controller  for  the  approach  and  landing  phase  of 
flight  STOL  F-15  using  LQG/LTR  synthesis  techniques  via  a 
software  package  originally  developed  by  Capt  R.  Floyd 
[ill.  The  controller  has  been  designed  about  a  nominal 
condition  of  119  knots  at  sea  level  with  a  light  gross 
weight  and  In  a  landing  configuration.  This  controller  is 
subjected  to  robustness  analysis  and.  If  required, 
robustness  enhancement.  The  analysis  is  accomplished  by 
means  of  a  linear  covariance  analysis  tool  developed  by  Lt. 
A.  Moseley  [251  and  by  a  nonlinear  analysis  tool  originally 
designed  by  Capt.  W.  Miller  (241  and  modified  for  this 
study.  Robustness  enhancement  will  be  attempted  using  the 
discrete-time  modifications  of  techniques  developed  for  the 
robustness  enhancement  of  continuous-time  regulators  by 
Doyle  and  Stein  (9,101. 

1-4  Sequence  of  Presentation 

Chapter  2  of  this  thesis  develops  the  CGT/PI 
controller,  starting  with  a  proportional  regulator,  then 
adding  the  Integral  characteristics  to  get  the  PI 
controller.  These  are  then  combined  with  the  CGT  to  form  a 
CGT/R  and  CGT/PI  controllers,  followed  by  a  discussion  of 
model  following  controllers.  Chapter  3  adds  the  Kalman 
filter  to  the  CGT/PI/KF  controller  and  discusses  the  Impact 


of  the  filter  on  robustness  as  well  as  a  robustness 


enhancement  technique.  Chapter  4  presents  the  system 
models  used  In  the  controller  design  for  the  STOL  F-15. 
Chapter  5  demonstrates  the  controller  design  process  and 
performance  analysis  used  in  this  study.  Controller 
designs  and  the  analysis  of  these  designs  are  presented  In 
this  chapter.  The  last  chapter.  Chapter  6,  contains  the 
conclusions  drawn  from  this  study  and  gives  recommendations 
for  further  study. 


II.  LOG  CONTROLLER  THEORY 


2-1  INTRODUCTION 

This  chapter  shows  the  development  of  optimal  Linear 
Quadratic  Gaussian  (LOG)  controllers  for  continuous-tine 
systems  having  sanpled-data  measurements.  The  development 
starts  with  a  full -state  feedback  model,  as  will  be 
described  In  Chapter  4  for  this  particular  application, 
assuming  perfect  measurements.  The  inaccessibility  of  all 
states  and  imperfection  of  measurements  will  be  considered 
in  the  next  chapter. 

The  three  controllers  to  be  developed  are  the 
proportional  regulator,  the  proportional  plus  integral 
controller  (PI)  and  the  open  loop  Command  Generator  Tracker 
(CGT).  Either  the  proportional  regulator  or  the  PI 
controller  can  be  combined  with  the  CGT  and  a  Kalman  Filter 
to  provide  the  controller  for  the  aircraft. 


2-2  EBSEgEII^Mk-EggyLAISB 

A  continuous-time  system  Is  assumed  to  be  described  by 
means  of  the  linear  stochastic  differential  equation 

x(t>  =  F< t )  i<t>  +  B(t>  u(t>  G< t)  w(t)  (2-1) 
where  jf(t)  is  a  zero  mean  white  Gaussian  noise  with 

Eiw(t)  wT(t+T>)  -  0<t)d<T>  (2-2) 

The  aircraft  considered  in  this  thesis  is  a 
continuous-time  system  with  sample-data  measurements.  It 
can  be  modelled  as  an  equivalent  discrete-time  model  U91, 
t.e.,  the  solution  to  the  differential  equat.on  (2-1),  by 


1 

sJ 


the  linear  difference  equation: 

X<ti  +  j)  *  I<ti  +  |,ti)j<ti>  +  B(](t|)u(t|)  + 
+  Gd(tj )wd(t1 ) 


<2-3) 


where  ^(tj)  Is  a  zero-mean  discrete- time  white  Gaussian 


noise  with 


E  t  wd  C 1 1  >  S£dT  <  t  ^  > }  =  Qd  <  1 1 ) 


(2-4) 


The  I  natrlx  Is  the  state  transition  matrix  associated  with 
F  and  Bd,  Gd,  and  Qd  are  defined  In  terms  of  I,  B,  G,  and 
Q#  as  Is  shown  In  Reference  19. 

An  optimal  discrete-time  LQG  controller  minimizes  the 
cost  functional 

J  -  E  (  i  xT(tn+1)  Xf  x(tn+l>  + 

2 

n  1ri<tlnTrx<t1)  s(ti>1  rx(ti>' 

+  I  -  )  (2-5) 

1=0  2Lh<  1 1  >J  LS(ti>T  U(tt)J  [«<*!>. 

where  tn  Is  the  last  time  at  which  a  control  may  be 
applied*  and  a  zero-order  hold  is  used  to  keep  the  control 
Inputs  constant  over  each  time  Interval.  The  weighting 
matrices  Xf  and  X(t|)  are  positive  semi-deflnlte  and  the 
U(tp  weighting  matrix  Is  positive  definite.  The  Xf  matrix 
is  used  to  control  the  cost  at  the  final  time  due  to  state 
deviations  from  desired  values  (zero  for  perturbation 
states)  and  the  X  matrix  weights  the  state  deviations  at 
the  Individual  sample  times.  The  U  matrix  Is  the  weighting 
matrix  that  determines  the  cost  of  applying  controls  to  the 
states.  The  S(t})  matrix  Is  chosen  so  that  the  symmetric 
composite  matrix  in  Equation  (2-3)  is  positive  semi- 
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definite  and  is  used  to  weight  the  cost  of  cross-terms. 
This  cross-term  matrix's  main  use  is  to  exert  control  over 
the  entire  Interval  and  not  just  at  the  sample  times  as 
would  occur  with  S(ti>  =  0  [201. 

For  this  problem,  the  LQ  optimal  full-state  feedback 


control  law  is  given  by 


u*<t! )=  -Gc*( t i )  £<t!>  (2-6) 

where  Gc*(ti>  is  the  solution  to 

Gc*<ti>*  (U+BdT  Kc<tl+l)Bd]“l[BdTKc(t1+1)l+ST]  (2-7) 


Kc(ti)«  X+  lTKc<tl  +  i)i-(BdTKc<tl  +  1>*+STlTGc*(ti)  (2-8) 

which  is  a  backward  running  Riccati  difference  equation 


with  a  final  condition 


Kc<*n+1>  =  xf 


(2-9) 


This  controller  is  represented  by  the  block  diagram 


in  Figure  2- 1 . 


The  preceding  regulator  may  not  be  satisfactory  when  a 
nonzero  steady-state  control  must  be  applied  with  a  zero 
input  to  the  controller.  For  example,  when  the  input  to 
the  controller  is  the  tracking  error  between  desired  and 
actual  values  of  the  controlled  variables,  even  when  this 
input  is  zero,  we  want  the  controller  to  generate  the 
(generally  nonzero)  output  to  maintain  the  system  at 
equilibrium  conditions  to  maintain  zero  tracking  error. 
This  can  be  achieved  if  the  controller  Includes  Integral 


action,  which  is  especially  beneficial  in  generating  zero 
steady  state  mean  tracking  errors  in  the  face  of  unmodelled 
constant  disturbances.  This  desire  to  achieve  the  atype-l 
property"  (201  motivates  the  use  of  a  PI  controller  (Fig. 

2-2)  with  its  summation  (or  pseudo-integration)  of  the 
regulation  error  Uc(ti^  controlled  variables, 

where  £c  is  the  controlled  variable  and  £d  is  the  reference 
signal  which  provides  the  input  to  the  controller. 

The  Incremental  form  of  the  PI  controller  will  be 
Implemented  in  this  thesis.  In  this  form  of  the 
controller,  only  the  changes  in  the  states  and  commands, 
and  not  the  states  and  commands  themselves,  are  used  to 
generate  increments  in  control  relative  to  the  value  at  the 
previous  sample  Instant.  This  form  is  preferable,  as 
initial  conditions  for  the  controller  states  are  not 
required  and  rel lnear izat ion  about  nominal  values  is  easier 
in  applications  where  the  system  is  nonlinear.  This  form 
also  lends  Itself  more  readily  to  anti-windup  compensation 
[201,  which  is  an  important  consideration  for  flight 
controls  that  are  easily  saturated. 

2-3.1  Control-Rate  Pseudo-Integration  for  Sampled-Data  Systems 
In  Section  2-2,  the  equivalent  discrete-time  difference 
equation  was  derived  from  a  continuous-time  system  model 
and  took  the  form 

S<ti+J)  »  l&<ti)  +  Bd*<ti>  (2-10) 


with  the  noise  vector  deleted  by  virtue  of  the  certainty 


equivalence  principle.  This  principle  states  that#  In  the 
generation  of  an  LQG  controller,  the  controller  gains  can 
be  evaluated  on  the  basis  of  the  corresponding 
deterministic  optimal  LQ  control  problem,  and  then  the 
full-state  feedbacks  are  replaced  with  Kalman  filter  state 
estimates  1201. 

For  this  thesis,  we  will  use  perturbation  state  and 
control  variables,  and  £u,  respectively,  defined  as 

|i(t()  =  x(tj>  -  xQ  <2-11) 

£u ( 1 1 >  =  u < 1 1 )  -  uQ  (2-12) 

where  x0  and  uQ  are  the  nominal  values  of  the  states  and 
controls  that  maintain  the  system  at  the  equilibrium  trim 
operating  condition  to  maintain  desired  output  values. 
Assuming  that  the  system  output  Is  a  linear  combination  of 
the  states  and  controls,  we  can  write: 

£c<ti>  *  Cx<tj[)  +  DyUCtp  (2-13) 

To  find  the  nominal  control,  uQ,  that  will  hold  the  system 
at  the  equilibrium  operating  point,  such  that  yc  equals  the 
desired  system  output, Equations  (2-10)  and  (2-13)  yield 

5o  =  b£o  +  Bd5lo  <2- 14a) 

Id  ~  c2o  +  DyUo  < 2- 14b> 

or 


-o  i  r<*-i)  Bd  -I  r so' 

-XdJ  L  c  Dy  J  Luo- 


(2-15) 


which  must  be  solved  for  x0  and  u0  In  terms  of  yd. 
solution  to  Equation  (2-15)  yields 


'So i  <*-i>  »d  1  rs  r*n  *121  [2 ' 

s  s 

.Ho  J  L  C  Dy  J  LsdJ  L  *2 1  *22  J  Lzd. 


<2-16) 


Therefore, 


So  *  *1 2Zd 


Ho  *  »22Xd 


<2-17) 


We  can  write  Equation  <2-12)  for  tlae  t}  and  subtract 


It  from  Equation  <2-12)  for  tlae  tj+j  to  get 


#u<tl+i)  a  fu<tf)  +  Iu<tl  +  1)  -  U(t|)] 


<2-18) 


which  Is  the  discrete-tine  equivalent  of  an  integration. 


Oe  f 1 n 1 ng 


Aa<ti>  «  <£< 1 1  +  j >  -  u<ti> 


<2-19) 


as  the  control  pseudo-rate.  Equation  <2-18)  becomes 


fa<ti  +  i>  -  iH<*i>  +  £H<M> 


<2-20) 


Using  Equations  <2-10)  and  <2-20),  an  augmented  state 


equation  can  be  written  for  the  perturbation  variables 


#x<ti)  and  fs<tj)  with  the  control  pseudo-rate  as  the 


input: 


«S<M  +  i> 


iH<ti+i) 


«  Bd 


0  I 


fs<ti> 


du  <  1 1 ) 


♦  <2-21) 
I 


2-3.2 


In  her  thesis  on  robust  flight  controllers  (15),  Lt 


Jean  Howey  employs  previously  developed  theory  (201  to  show 


that  the  desired  integral  characteristics  can  be  achieved 


by  manipulating  the  discrete-time  equivalent  of 


u*<  t) 


■  -Kx  *<t)  +  Kz  Cyd  -  yc<r) 1  dT  <2-22) 

"  n  " 


which  Is  given  by 


'&<'■  y.-v 


SSfidSB 


.  •  ,  .  -  .  i  .  -  0  s- 


ssaauiii 


f-f 


(2-23) 


i-  1 

u*<tp  =  -Kx  x(tj)  +  Kz  1  [jLd  -  Zc<t4>] 

J=-l 

This  discrete-time  equivalent  equation  is  then  put  into 
incremental  form  and  rewritten  as  a  perturbation  equation 


to  yield: 

du*(tl+i>  =  du*(ti)  -  Kxt4x(ti+1)  -  dx<ti>J 
-  Kz  [ CdX < 1 1 )  +  Dy#u(t1)i 


(2-24) 


The  above  result  is  then  compared  to  the  optimal 
regulator  solution  shown  in  Section  2-2  as  augmented  by  the 
control  pseudo-rates  and  subject  to  a  quadratic  cost 


criterion: 


1  [tt<tn+1>  T  Xf  0  ii(tn+1> 

2  5il<tn+l)  0  0  du(tn+i> 

fl<t|>~|  T  [Xu  Xi2  Sf 
fu(ti)  Xj2T  x22  S2 

^u(ti).  S2^  U 


dx(ti)- 

du(ti)  (2-25) 
^u(tj). 


where  Xjj  is  the  weighting  matrix  associated  with  state 
deviations  from  the  nominal  state  trajectory,  X22  weights 
control  deviations  from  uQ,  and  U  is  the  weighting  matrix 
associated  with  control  pseudo-rates.  This  U  matrix  gives 
the  designer  a  tool  with  which  to  place  a  weighting  on  the 
rate  of  change  of  control  Inputs  and  thereby  enable  him  to 
Iterate  on  the  design  readily  so  as  to  prevent  the  system 
from  commanding  actuator  rates  greater  than  physically 
realizable.  The  Xf  matrix  weights  deviations  of  the  state 
at  the  final  time.  The  cross  terms,  Xj2»  sl»  and  s2»  are  a 


„  r*  -  *  ■  '  *i  "  -  *  *»  "  ■  "  *  *  *  ”  •  ’  • 
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by-product  of  the  conversion  of  the  system  from 
continuous-time  cost  to  discrete-time  cost.  This 
development  is  shown  in  References  10  and  14.  The  Index  for 
the  summation  In  the  immediately  preceding  cost  equation 
begins  at  -1  rather  than  zero  to  provide  an  acceptable 
transient  response  to  a  change  in  setpoint,  which  may  be 
large  compared  to  succeeding  control  differences  (151. 

Applying  the  optimal  regulator  solution  to  Equation 
<2-25)  and  achieving  a  constant-gain  control  law  by 
allowing  n  —*•,  the  steady-state  control  law  is  generated  as 
AB*(t|>  =  -Gcl*  #I<ti>  -  Gc2*  du< t i >  (2-26) 

which,  when  combined  with  Equation  (2-20),  yields: 

£u*(ti+1>  -  fH*<ti)  -  Gc |*  #£<ti>  -  Gc2*  #u*<ti>  (2-27) 

*  !u*<t!>  -  tGcl*  Gc2*1  fditt!)]  (2-28) 

£u<tj) 

Rewriting  Equation  (2-24)  with  the  upper  partition  of 
Equation  (2-21)  yields: 

£u(t i  +  t >  *  du ( t j[ )  -  IKX  KX1  r<«-I>  Ba]  Tditti)’ 

[_  C  DyJ  [duftpj  (2-29) 
which,  when  compared  with  Equation  (2-28),  shows  that 

<  ■- 1 )  Bd  1  “ 1 

tKx  Kz]  -  CGcl*  Gc2*1  (2-30) 

C  Dy 

and  therefore 

„  *  *11  *12* 

CKX  Kz J  «  IGcl*  Gc2*J  (2-31) 

*21  *22 

This  equation  gives  feedback  gains  as  follows: 

Kx  *  Gci*  W11  +  GC2*  *21  <2-32a> 


<  2-32b> 


Kz  ■  Gel*  *12  +  Gc2*  *22 
where  Gc j *  and  GC2*  are  found  via  the  augmented  state 
regulator  solution  and  wji,  *12>  v21»  and  *22  are  defined 
In  Equation  <2-16).  This  leads  to  the  Incremental  form  of 
the  PI  controller: 

#u*<tm>  =  $u*<t!>  -  Kx  tfxCtj  +  i)  -  #z<l: |  >  1 

+  Kz  tYd<tl+l)  -  ic<tl>i  <2-33> 

which  achieves  the  desired  Type-1  control.  It  Is  proper 
that  the  time  Indices  for  the  last  two  terms  do  not  match 
1201 . 

2-4  COWHAND  GENERATOR  TRACKER 

This  section  presents  the  fundamentals  of  Command 
Generator  Tracking,  a  formalization  of  numerous  model 
following  concepts.  Por  a  more  complete  development  of 
these  controllers,  see  also  Reference  20  and  the  work  of  J. 
R.  Broussard  [5,61. 

For  a  given  system  to  maintain  desired  trajectories 
In  real  time.  It  must  respond  appropriately  to  commanded 
inputs  and  must  reject  disturbances.  Both  the  desired 
trajectories  and  the  disturbances  to  be  rejected  are 
formulated  as  the  outputs  of  linear  system  models.  The 
command  generator  model  Is  defined  as 

ja<t>  *  Aa&a<t)  +  Baua( t )  (2-34) 

with  the  output  equation  of 

Xa<t)  =  Cn£a(t)  +  Daun(t)  <2-35) 

In  the  discrete  fora,  these  equations  become 
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*  ImSm<ti)  ♦ 


(2-36) 


and 

Xm(t i >  =  Cmlm^i*  ■*•  Daua(tj)  (2-37) 

Note  that  the  Cm  and  Da  in  Equation  (2-37)  can  be  different 
fro*  those  In  Equation  (2-35)  to  reflect  the  desire  to 
control  variables  over  the  entire  sample  period  and  not 
just  at  the  sample  times  (201. 

The  objective  of  the  CGT  controller  is  to  force  the 
output  of  the  system  model  to  match  the  output  of  the 
command  model, 

Xc<ti>  38  Xm^P  (2-38) 

where  ( t i >  is  the  output  of  the  linear  t lme- invar iant 
system 

I<ti  +  1)  “  *I<ti>  +  Bc|S£<  t;  |  >  +  Exnd(tj)  (2-39a> 

*C<M)  *  Cf(tj)  +  Dy  u  ( 1 1  >  ■fEynd(t|)  (  2-39b) 

In  the  above  equations,  n<j  is  a  disturbance  modeled  by 

Qd^i  +  l*  “  ^nSd^M*  +  ®dnQcmd*^P  +  ^dnSdn^i*  (2-40) 
where  nCBd  is  the  commanded  input  to  the  disturbance 
shaping  filter  (here  assumed  to  be  zero  for  simplicity), 
and  Sdn**'*)  ls  a  white  Gaussian  noise  with  mean  of  zero 
and  a  covariance  Qdn. 

The  error  that  arises  from  deviations  at  any  time  t} 
ls 

£(ti>  =  Ec^l*  “  (2-41a> 

or,  from  Equations  (2-13)  and  (2-37), 


x(t  |  ) 

e(  t  j )  «  CC  Dy  Eyi  M<^i)  -  CCB  DB1  r*m(tl)‘l  (2-41b) 

[Qd < ^ i  > J  L«m<M> 


f. 

jr] 

v,| 


When  this  error  Is  zero,  the  system  Is  said  to  be  tracking 
the  "Ideal  state  tra jectory . " t 1 1 1  This  Ideal  system  must 
be  defined  so  as  to  satisfy  the  original  state  and  output 


equations  and  so  must  take  the  form 

£l<ti  +  i>  =  ixj<tp  +  BjjUitti)  +  Exn(j<ti> 


it  I  <  t  i )  =  Cxi<t[)  +  DyUj(ti>  +  Eynd<ti>  (2-< 

where  xj  and  yj  are  the  ideal  state  and  output  vectors, 
respectively.  The  ideal  system  must  also  maintain  zero 
error  between  the  system  and  command  model  outputs,  ( le 
e(t;)  =  0),  so  that  yj  equals  ym  for  all  time  ti,  or 


(2-42a> 


<2-42b> 


xj  <  1 1 ) 

[C  Dy  Ey]  uI(ti)  =  tcm  Dm]  rxm<ti> 
Qd<M>  L-m(tl> 


C  2-43) 


The  ideal  plant  response  must  also,  by  assumption,  be  a 
linear  function  of  the  model  state,  model  control, 
disturbance  state,  and,  if  applicable,  disturbance  control 
input :  [151 


r A 1 1  a12  a  1  3l  f 2Lm < ^  i  >" 

=  I  a21  a22  a23  I 

_uI(ti)J  Lnd<ti>. 


(2-44) 


2-4.1  Open-Loop  CGT 

To  solve  this  open  loop  CGT  problem,  the  equations 
that  the  A^j  matrices  in  Equation  (2-44)  must  satisfy  have 
to  be  set  up  and  solved.  By  augmenting  the  forward 
difference  expression  for  x  j ( t  j  >  from  Equation  (2-42a>  with 
yj(ti>  from  Equation  (2-42b>: 


;V  "P-  V  -  -V  A  ■’ .  • 


2l(tUl>  '  Il<M> 


*I<M> 


'<■-1)  Bd' 

'xi<ti>' 

C  Dy 

»  * 

ui<ti) 

ad<ti> 


<2-45) 


By  substituting  the  assumed  forms  of  £i<tp  and  uj<tp  from 
Equation  (2-44),  this  becomes: 


Sl<tl+1>  -  II<ti) 

<i-I)  Bd 

A11  A1 2  A1 3 

Im<ti> 

= 

«■»<*!> 

*!<*!> 

C  Dy 

a21  a22  a23_ 

Bd<M> 

+  jXJ  Ud<t  i )  (2-46) 

The  forward  difference  expression  for  xi<tp  can  also  be 
obtained  by  writing  the  upper  partition  of  Equation  (2-44) 
for  times  t{  and  ti+i  and  taking  the  difference  to  yield: 

nu<M+i>“*m<M>l 

t*I<tl  +  l)-xI<tl)l  *  (An  A12  a13j  |jlm<tl  +  l>“llm<tl>  <2-47) 

Lad<ti  +  l)"Qd<tl>J 


Assuming  um  to  be  either  constant  or  at  least  slowly 
varying  with  respect  to  the  sample  period  (l.e., 
Um<tl+l)"Sm<ti>  *  using  the  state  models  for  xm  and  n^ 
as  given  in  Equations  (2-36)  and  (2-40)  respectively,  and 
deleting  the  driving  noises  yields: 


[il<tl+1)-s1<tl)l  * 


f<«m-I> 

®dm 

0  1 

'*■»<*!)- 

*  tAll  A 1 2  A 1 31  0 

0 

o 

«m<M> 

L  0 

0  <In-I)J 

.ad<ti). 

Using  the  fact  that  for  all  time  tj,  one  can  write 

the  expression 

XI<M>  *  lCm  D.J  fi^ti)]  (2-49) 
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Multiplying  the  matrices  of  Equation  (2-48)  gives 


[■ 


Sl<ti+l)‘£l(ti> 

*i<ti> 


] 


'All<«r 
I  = 

C. 


i  * 

lim^i* 

Sd(ti) 

(2-50) 


All**m“I*  ^ll®dm  A13**n”** 

Dm  0 

Equating  the  two  expressions  for  the  forward  difference  of 
xi(tj)  and  the  output  i i < 1 1 > #  Equations  (2-46)  and  (2-50), 
yields : 

.  ^  *1  F  1  « 


r<«-i>  Bdi  r 
L  c  dy\  L 


A11  A12  a13 
a2 1  a22  a23 


■  [ 


ih 

J 

ad 


Ctt> 
&d<M> 


+  LEyJ  Sd(ti> 


Atl<*«-I>  AllBdm  A13<«n-I> 


]' 

m 


* 1  * 
nd(ti) 


(2-51) 


which  can  be  rearranged  into: 


r<i-i>  ed]  r 

L  c  DyJ  i 


All  A l 2  A 1 3 
A2 1  a22  a23 


] 


■t 


AH<«m-I)  AnBdm  Ai3<«n-I)-E 


D, 


-E, 


tl  ["sm^i*"! 

J 

[ad<M>J 


=  0  (2-52) 


Since  this  expression  must  hold  true  for  arbitrary  xm,  um, 
and  nd  at  any  given  sample  time,  the  quantity  in  the  braces 
must  equal  the  zero  matrix.  Therefore, 


[ 


A11  A1 2  A1 3* 
a2 1  a22  a23 


■  r-tt  ^  1 2*1  r 

|»21  »22J  L 


*12 
* 22 


*Au<«m-I)  AHBdm  Ai3<ln-I)-Ex  (2-53) 


Dm  Dm  -Ej 

which  can  be  written  as  the  following  set  of  partitioned 
equat ions : 

A11  *  *\ 1A1 >  +  w12cm  <  2-54a) 

A 1 2  *  w 1 lA 1 lBdm  +  w12Dm  <2-54b) 

A 1 3  *  W1 lA13<*n_I >  “  wiiEx  -  wi2Ey  <2-54c) 
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( 2-54d> 


A21  ■  V21All<lm~I>  ♦  *22cm 
A22  *  »21AllBdm  ♦  *220*  <2-54e> 

a23  *  w21A13*Bn“* >  “  *21®*  “  *22®y  <2-54f> 

Equations  <2-54a)  and  < 2-54c>  are  of  the  fora  X  =  AXB  +  C, 
assuming  lB  and/or  lQ  are  not  the  Identity,  and  can  be 
solved  numerically  for  X  (41.  Achieving  a  unique  solution 
by  the  above  method  is  dependent  upon  the  following 
relationships.  First,  the  product  of  any  of  the  eigenvalues 
of  «||  and  any  eigenvalue  of  <1^-1 >  must  not  be  unity  and 
second,  the  product  of  any  of  the  eigenvalues  of  and 
<ln-I)  also  cannot  equal  one. 

Once  An  and  M3  are  determined,  the  rest  of  the  A 1  j 
matrices  can  be  evaluated  and  the  open-loop  C6T  law  can  be 
written  from  the  lower  partition  of  Equation  (2-44)  as 
(111: 

ui<ti>  ■  A2iIH<ti)  +  A22£n(tP  +  A23Qd<tl>  (2-55) 

The  open-loop  CGT  is  shown  in  Figure  2-3. 

2-4.2  CGT/Requlator 

The  open-loop  CGT  law  is  usually  not  appropriate  as 
It  can  not  be  used  with  unstable  plants  or  plants  with 
undesirable  performance,  and  it  cannot  handle  the  uncertain 
parameters  or  unmodeled  disturbances  that  generally  occur 
in  the  true  system.  Therefore,  to  force  the  perturbations 
from  the  Ideal  plant  trajectory  to  zero,  a  feedback 
controller  must  be  developed.  The  first  step  In  this 
process  Is  to  assume  that  the  open-loop  CGT  law,  uj<t|>  has 
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teen  evaluated  for  all  tj,  yielding  the  ideal  atate 
trajectory  n<t|)  for  all  t}. 

To  generate  the  LQ  optiaal  regulator  for  the 
deteralnist ic  system,  or  by  certainty  equivalence,  the  LQG 
regulator  for  a  full-state  feedback  sytea,  perturbation 
variables  must  be  defined: 

f£(ti>  ■  j(tj>  -  5j<t|)  (2-56a) 

#u<i>»  n<ti>  “  MI < t& >  (2-56b> 

fZc**!*  ■  Zc^P  “  Zl<*P  ■  Xc<ti>  “  Za<t|>  < 2-56c> 
This  yields  a  deterministic  perturbation  state  equation  of 

+  +  Bdfmti)  <2-57> 

and  a  steady  state  constant-gain  LQ  optimal  regulator  law 
as 

ffittp  *  -Gc*fi<t|)  (2-58) 

This  can  be  written  in  the  preferred  Incremental  form  to 
yield  an  equivalent  closed-loop  CGT  control  law  [201  of 
■  fl<ti)  +  <Hl<ti  +  |>  " 

(2-59) 

+  Gc*tII<ti  +  i>  -  Sl<ti>J  +  Gc’*rli(t1  +  1)  -  5(ti>] 

2-4.3  Closed-Loop  Command  Generator  Tracking  with  FI  Control 
The  derivations  of  Sections  2-3.2  and  2-4.1  may  now 
be  combined  in  a  closed-loop  CGT/PI  controller.  This 
controller  will  force  the  actual  system's  mean  output  to 
match  that  of  the  command  model  in  steady  state,  even  with 
some  modeling  errors;  it  can  handle  constant  unmodeled 
disturbances  as  well  as  the  modeled  ones;  and  it  Includes 
the  model  control's  feedforward  contribution  to  the  real 
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system  control  signal. 

In  the  previous  sections,  it  has  been  assumed  that  um 
is  constant  from  t0  forward.  In  reality  um  will  change  and 
this  will  conceptually  cause  the  time  index  to  be  set  to 
zero.  This  causes  an  inconsistency  in  the  definition  of 
the  ideal  trajectory.  To  avoid  this,  the  actual 
implementation  of  the  command  generator  model  to  take  the 
form  [151: 

Sm^i  +  l^  =  +  ^dmiim^i  +  P  (2-60) 

as  opposed  to  the  form  of  Equation  (2-36). 

Using  the  open-loop  CGT  law  u j ( t j )  of  Equation 
(2-55),  the  associated  ideal  state  trajectory  xi<tj)  of 
Equation  <2-42a),  and  defining  the  ideal  trajectory  of 
control  differences  as: 

An  i ( t  i )  s  u i ( t  i  + 1 )  -  ui<tj> 

=  A21c-Im(ti  +  l)  -  4  A23c£d< 1  i  + 1  >  “  ild(M)]  (2-61) 

The  deterministic  augmented  perturbation  system  state 
equation  is  similar  to  Equation  (2-25),  but  with  Au 
replaced  by  £A_.  ,  where  £Au  is  defined  by 

<£Au  (  t  i  )  3  Au  ( t  j  )  -  Aurtj)  (2-62) 

The  LQ  optimal  perturbation  regulator  solution  to  this 
system  is  given  by: 

( t  j )  =  -Gcl*fx(ti)  -  Gc2*iu(ti)  (2-63) 

Substituting  for  £Au,  $x,  and  $u;  and  shifting  the  time 
argument  backward  by  one  sample  period  yields: 


a<t i >  -  a<t|-i>  ♦  + 

-  Gcl*tI<tl-l>‘Al lS»<ti-l>“A12a»<ti>’*13Bd<tl-l>J  “ 

"  Gc2*tH<ti-l>"A2lX»<ti-l)"A22a*<ti>"A23Bd<ti-i> J 

(2-64) 

which,  while  being  In  the  Incremental  fora.  Is  only  a 
type-0  controller.  Note  that  the  tlae  arguments  on  both 
H.'s  reflect  the  modification  of  Equation  (2-60) 

The  desired  integral  property  can  be  achieved  by  a 
controller  of  the  form: 

iU<t,>  -  "  IK,  Kz]  fflCti)  -  ) I 

L  #Xc<tl-l>  J  (2-65) 

Using  the  perturbation  variables  defined  In  the  previous 
section.  Equation  (2-65)  can  be  written  as: 


H<M>  *  SI<M>  ♦  S<«1-1>  -  ill < 1 1- 1 ) 

-  K,[ j|(t | )  -  S<«i-i>l  +  KsISi(tl)-sI(ti_1)l 

♦  Kz ( iB( t  j . j )”XC( 1 1 -| > 1  (2-66) 

Writing  the  backward  difference  of  Equation  (2-44)  yields: 

rii<ti)-n(t|.1)"|  [An  A12  Ai 3!  rx«(ti>-xB(tt.i>n 

Sm<ti>-flm<ti-l>  (2-67) 

Lai<tl)-ui(t|-|)J  LA21  A22  A23-J  LOd^P'Bd^i-pJ 

This  can  be  substituted  into  Equation  (2-66)  to  yield  the 


desired  Incremental  form  of  the  CGT/PI  controller  (201: 


a(tt>  ■  a(tl-P  ”  Kj|Cx(ti)-x(t|-|)  J 

+  Kz  (C,  0.1  Xa(t|-{)  -CC  D»1  jc ( 1 1 « j ) 

Bm<tl>  S<M-1> 

+  CK,Aii+A2il  U«<ti)-IB(tl_1)l 

+  IK, Aj  3+A23I  tad<ti)-Qd<ti-l>l  (2-68) 

which  Is  shown  In  Figure  2-4. 


25 


CGT/PI  Controller 


The  CGT/PI  controller  derived  In  the  above  section  Is 


an  example  of  a  model  following  controller.  The  CGT  Is  an 
explicit**  model  following  controller.  In  which  the  command 
model  used  Is  the  Ideal  performance  model,  possibly 
Including  a  disturbance  rejection  model.  The  CGT  and  the 
explicit-model  follower  are  feedforward  phenomena  and  have 
no  effect  on  system  closed-loop  properties  (201. 

Implicit  model-following  control  may  be  added  to  the 
PI  regulator  by  the  Inclusion  of  an  Implicit  model  Into  the 
performance  Index.  The  PI  controller  forces  the 
perturbation  outputs  of  the  system  to  mimic  the  dynamics  of 
the  Implicit  model.  The  addition  of  the  Implicit  model 
Incorporates  weights  on  deviations  In  the  rate  of  change  of 
the  output  variables  from  the  desired  characteristics  and 
also  on  the  control  pseudo-rates.  As  the  Implicit 
model-following  controller  is  a  feedback  phenomenon,  it 
directly  affects  the  closed-loop  characteristics  of  the 
system.  Including  stability  robustness  111,20,211. 

The  following  derivation  of  the  Implicit  model 
following  controller  Is  for  the  continuous- time  full-state 
feedback  regulator,  but  the  concepts  have  been  extended  to 
sampled-data  PI  controllers  t 11,241.  Consider  a  full-state 
feedback  system  adequately  described  as  the  linear 
time- Invariant  model: 

j<t>  -  ¥  i<t>  +  B  5|<t> 


(2-69) 


with  a  quadratic  cost  function  defined  as: 

Jj  -  %  f*  (zT<t)X*<t)  +  uT<t)Uu<t> 1  dt  <2-70) 

Jo 

which  places  a  quadratic  penalty  on  deviations  fro*  zero  of 
both  state  trajectory  and  control  energy.  Given  the 
Infinite  tine  Interval  of  Equation  (2-70),  a  constant-gain 
full-state  feedback  control  law,  derived  using  LQ  synthesis 
techniques,  would  take  the  for*: 

u*<t)  «  -Gc*£<t>  (2-71) 

or,  for  the  case  of  an  equivalent  dtscrete-tlae  syste*  as 
shown  In  Section  2-2,  the  law  would  take  the  for*  of 
Equation  <2-6),  as  defined  by  Equations  (2-7)  through 
<  2-9) . 

It  Is  aasuaed  that  the  syste*  outputs  can  be  written 

as: 

yc<t>  »  Cx<  t>  (2-72) 

a  linear  coablnatlon  of  the  states.  If  the  desire  Is  not 
to  drive  the  conponents  of  the  state  vector  to  zero,  but  to 
force  the  syste*  output  to  natch  the  dynamics  of  a  given 
■odel  syste*  depicted  as: 

iB<t>  *  FftX*<t)  <2-73) 

the  cost  in  Equation  <2-70)  associated  with  the  state 

•  • 

deviations  would  change  fro*  5TXg  to  <I“FBx)TYi<y-PBy) .  By 
conblnlng  this  relation  with  Equations  <2-69)  and  <2-72), 
the  cost  function  nay  be  rewritten  as: 

Jj  -  *  CzTXji  +  uTuu  +  2zTsrul  dt  <2-74a> 


where 


Xj  -  <CF  -  FmC)TY!<CF  -  F*C> 


<  2-74b) 


Uj  =  U  +  BtCtYiCB 

(2-74c> 

S!  =  (CP  -  FmC)TY!CB 

( 2-74d> 

As  with  the  S  matrix  of  Equation  (2-5),  the  purpose  of  the 
Si  terms  In  Equation  (2-74a)  Is  to  exert  control  on  the 
rates  of  change  of  system  outputs.  Given  this  cost 
function,  the  control  law  In  either  Equation  (2-71)  or 
(2*6)  can  be  synthesized  by  LQ  techniques  121,24). 

At  this  stage  In  the  development  of  a  flight  control 
law,  the  goal  Is  to  design  as  robust  a  controller  as  Is 
possible,  to  set  a  bound  on  performance  that,  once  a  Kalman 
filter  Is  embedded  In  the  loop,  will  be  asymptotically 
approached  using  Loop  Transfer  Recovery  (LTR)  robustness 
enhancement  techniques.  It  has  been  shown  that,  to  decrease 
the  sensitivity  of  the  controller  to  parameter  variations, 
and  therefore,  make  It  as  robust  as  possible,  the 
closed-loop  eigenvectors  should  be  kept  as  orthogonal  as 
possible  112,24).  This  may  be  accomplished  by  the  proper 
selection  of  the  implicit  model  and  the  weights  on  the 
control  pseudo-rates  and  on  deviations  of  output 
derivatives  from  model  derivatives.  With  the  controller 
designed  for  robustness,  the  technique  to  be  discussed  In 
the  next  chapter  may  be  used  to  recover  some  of  the 
robustness  lost  from  the  Inclusion  of  a  Kalman  filter. 


2-5  SUMMARY 


This  chapter  developed  the  deterministic  optimal  LQ 
controllers  for  cont inuous-t l me  systems  having  sampled-data 
measurements.  The  development  began  with  a  simple 
regulator,  and  then  a  proportional  plus  integral  controller 
was  described.  Next,  a  command  generator  tracker  was 
developed  and  was  subsequently  combined  with  the  regulator 
and  the  PI  controller,  respectively.  Finally,  model 
following  controllers  were  discussed,  along  with  their 
contribution  to  system  robustness.  In  the  next  chapter 
uncertainty  and  incomplete  measurements  (versus  full  and 
perfect  access  to  the  states)  will  be  introduced,  requiring 
the  addition  of  the  Kalman  Filter. 
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III.  KALMAN  FILTER I MG  AMD  ROBUSTNESS 


3-1  Introduct Ion 

In  the  previous  chapter,  controller  development  was 
based  implicitly  on  the  assumption  that  all  of  the  states 
of  the  assumed  system  model  were  accessible  and  measured 
perfectly.  This  is  obviously  not  the  general  case  which 
involves  Incomplete,  noise-corrupted  outputs  of  physical 
sensors.  The  Kalman  filter  is  often  used,  and  is  developed 
here,  to  generate  optimal  estimates  of  the  states  from  the 
outputs  of  these  sensors  (221.  By  certainty  equivalence 
1201,  this  structure  then  provides  the  optimal  stochastic 
controller  under  the  LQG  assumptions. 

The  addition  of  the  Kalman  filter  into  the  loop  has  a 
negative  effect  on  the  robustness  of  the  system,  l.e.  the 
ability  of  the  system  to  tolerate  design  uncertainties 
while  providing  stable  characteristics  and  desired 
performance.  This  chapter  will  address  a  specific  form  of 
Kalman  filter  tuning  as  a  method  of  asymptotically 
recovering  the  good  robustness  characteristics  achieved  for 
full-state  feedback  controllers  via  Implicit  model 
following  In  the  previous  chapter. 

3-2  Kalman  Filtering 

The  CGT/PI  controller  of  Chapter  2  assumes  full 
knowledge  of  all  system  and  disturbance  state  vectors.  In 
general  the  states  are  not  entirely  available  directly  from 
measurements  of  the  states,  but  are  only  available  as 


sensor  Measurements,  often  incomplete  (In  the  sense  that 
there  are  not  separate  Measurements  of  all  states  of 
Interest),  and  corrupted  by  noise.  This  Motivates  the  use 
of  a  Kalman  filter  to  generate  estimates  of  the  states.  A 
development  of  the  Kalman  filter  follows,  but  for  a  more 
ln-depth  explanation,  see  Reference  19. 

The  available  sampled-data  sensor  outputs  are  assumed 
to  be  modelled  by: 

z<ti>  =  Hx(ti>  +v(tj>  (3-1) 

where  H  Is  the  measurement  matrix  and  v(tj)  Is  a  zero-mean 
white  Gaussian  noise  with 

E(v(t1)vT( j>>  =  R  (3-2) 

This  measurement  noise  is  assumed  to  be  independent  of  the 
dynamics  driving  noise. 

Through  the  use  of  Bayes  rule,  the  optimal  estimation 
algorithm  (Kalman  filter)  can  be  defined  In  terms  of  the 
conditional  mean  and  covariance  of  the  state  vector  just 
after  a  measurement  has  been  Incorporated  : 

A 

x(  1 1  -  t"*-)  ■  E(j(  1 1  _  i  )  !  Z(  1 1  _  i  >  =  Zt_i>  (3-3) 

A  A 

P(ti-i+)  ■  E{Cs(ti_l)-x(ti-l+)nx(tl_1)-x<tl_l+)]T 

:Z(tl_l)-Z|-|)  (3-4) 

where  ZCt}.})  Is  a  composite  vector  of  the  entire 
measurement  history  and  Is  a  vector  of  the 

realizations  of  Z(t^.;).  These  values  are  propagated  to  the 
next  measurement  time  to  yield  : 

A 

x(tt-)  ■  E{£(tl)!Z(tl_l)=Zl_1}  C 3-5) 
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(3-6) 


flSjj,  Ptti")  ■  EU  jttp-jCtj")]  tittp-sttj-)  JT 

■V.T' 

!Z(t j_j ) »2 i_i ) 

Using  these  relationships  and  the  systea  equation  froa 
Chapter  2,  the  Kalaan  filter  equations  are  as  follows: 


I<ti">  =  I  £<ti_i+>  +  Bd  utti-p  <3-7a> 

P(ti_)  *  I  P<  1 1  _  j  +>  IT  +  Gd  Qjjtti-i)  GdT  ( 3-7b) 

KCtj )  *  Ptti")  HT  CH  PCtj")  Ht  +  R]  _1  <3-7c) 

A  A  A 

l<tj+>  *  +  K<  tj  )  [ z i  -  H  2< t > 1  (3-7d) 

Pttj  +  J  =  P<ti")  -  K< 1 1 )  H  P(ti“)  <3-7e> 


The  Kalaan  filter  Is  Inserted  into  the  loop  as  shown 
In  Figure  3-1.  The  outputs  of  the  filter  are  fed  Into  the 
optlaal  deterain 1st ic  controller,  replacing  the  actual 
state  z<ti>  that  was  assuaed  accessible  during  that 
controller's  derivation,  which  yields  the  control  vector 
u<ti> . 

3.3  Effects  of  Kalaan  Filtering  on  Robustness 

Robustness  Is  the  ability  of  a  systea  to  aalntaln 
stability  and/or  perforaance  In  the  presence  of  variations 
froa  design  conditions  1261.  Full -state  feedback 
controllers  designed  via  LQ  technique,  while  varying  In  the 
degree  of  robustness,  all  attain  at  least  a  alnlaua 
guaranteed  stability  robustness.  When  the  states  of  the 
controller's  systea  are  estiaated  by  a  Kalaan  filter,  auch 
of  the  robustness  and  all  of  the  guarantees  are  ellatnated. 
The  desire  In  aulti variable  flight  control  design  is  to 
achieve  a  controller  that  will  provide  both  stability  and 
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Figure  3-1.  CGT/PI/KF  Controller 


performance  robustness  In  the  face  of  uncertainties  In  the 
system,  and  at  least  stability  robustness  In  the  presence 
of  massive  changes  In  system  characteristics  (211.  These 
changes  may  result  from,  for  Instance,  mlsmodelllng  of  the 
system.  Ignored  actuator  dynamics,  nonl l near  It les,  or 
failure  of  control  surfaces. 

3-4  Robustness  Analysis 

In  this  research,  robustness  analysis  was  conducted  by 
using  proposed  controllers  In  simulated,  linear  and 
nonlinear  • truth-mode 1 “  environments.  Figure  3-2  shows  the 
basic  form  of  these  simulations,  where  the  truth  model 
differs  In  structure  between  the  linear  and  nonlinear 
simulations,  but  the  controller  does  not.  The  linear 
simulation  was  a  covariance  analysis  using  the  program 
PFEVAL  written  by  Lt .  A.  Moseley  for  his  AFIT  thesis  1251. 
The  results  of  this  analysis  are  the  root  mean  square  (rms) 
values  of  the  state  values  and  control  Inputs.  For  a 
linear  system,  the  covariance  analysis  is  preferred  as  a 
single  run  of  the  covariance  analysis  yields  the  statistics 
required  for  controller  evaluation,  but.  In  the  face  of 
nonlinearities,  a  Monte  Carlo  study  Is  required  119].  This 
was  the  purpose  of  the  nonlinear  simulation  which  allowed 
for  the  saturation  of  actuators,  as  well  as  unmodelled 
higher-order  dynamics,  and  also  variation  In  the  parameters 
that  were  used  In  the  design  of  the  controller. 

The  tool  used  for  the  nonlinear  simulation  was 
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originally  developed  by  Major  William  Miller  124)  and  was 
Modified  by  Lt.  Robert  Houston  and  this  author. 

Originally*  the  program  ODEACT  was  hardwired  for  the  AFTI 
F- 16  and  did  not  allow  for  the  Inclusion  of  a  Kalman  filter 


In  the  evaluation.  The  modifications  to  the  program* 
renamed  ODEP15*  include  hardwiring  of  the  program  for  the 
STOL  P-15  and  possible  inclusion  of  a  Kalman  filter  with 
Monte  Carlo  analysis.  The  actual  modifications  and  a  list 
of  the  computer  code  are  Included  In  Appendix  A. 

3-5  Robustness  Improvements 

Two  methods  are  used  in  this  research  to  Improve  the 
robustness  of  the  controlled  system.  The  first*  implicit 
model  following*  Is  Involved  directly  in  the  design  of  the 
deterministic  optimal  full-state  feedback  controller  and 
was  discussed  In  Chapter  2.  The  second  Is  the  Doyle  and 
Stein  technique  for  tuning  the  Kalman  filter  to  recover 
robustness  characteristics  of  a  full-state  feedback  design. 

In  their  paper  "Robustness  with  Observers"  191*  J.  C. 
Doyle  and  Gunter  Stein  develop  a  technique  for  robust lfylng 
a  controlled  system  that  Is  fed  estimates  of  states  from  an 
observer  or  state  estimator.  Assumptions  of 
controllability*  observability*  and  minimum  phase  of  the 
system  design  model  are  made  and  only  continuous  time 
systems  are  considered.  The  basic  claim  for  this  technique 
is  that*  If  the  mappings  of  the  return  difference  matrices 
(the  multiple-input*  multiple-output  analog  to  the 


denominator  of  the  single-input,  single-output  closed-loop 
transfer  function)  of  the  observer-based  controller  are 
asymptotically  equal  to  those  of  the  full -state  feedback 
controller  when  the  control  loops  are  opened  at  the  point 
of  entry  of  the  control  inputs,  then  the  robustness  of  the 
controller  will  asymptotically  approach  that  of  the 
full-state  feedback  controller. 

Previous  AFIT  papers  C 15, 17,211  have  extended  the 
Doyle  and  Stein  technique  to  discrete-t lme  measurements  and 
have  attempted  to  use  this  method  in  conjunction  with  a  PI 
controller.  The  technique  was  successfully  applied  to  a 
discrete-time  regulator,  but  could  not  beneficially  be 
Implemented  with  a  PI  controller.  The  discussion  of  the 
discrete-time  methods  below  Involves  an  approximation  to 
the  continuous-time  case  and  these  mehtods  are  set  up  for 
robustness  enhancement  of  regulators  as  opposed  to  PI 
controllers. 

To  implement  the  Doyle  and  Stein  technique,  the 
GdQdGdT  matrix  of  Equation  <3-7b)  is  modified  such  that  Gd 
is  now  set  to  the  identity  matrix,  I,  and: 

Qd«D  s  «do  +  q2  Bd  V  BdT  <  3-8) 

where  040  is  the  original  noise  covariance  as  was  defined 
in  Equation  (2-4),  q  is  a  scalar  variable  that  is  a 
function  of  the  amount  of  robustness  enhancement  desired, 
and  V  is  a  positive  definite  symmetric  matrix,  often  set  to 
the  identity  matrix,  I.  This  can  be  Interpreted  as  adding  a 
noise  of  strength  q2V  at  the  control  entry  points.  The 


modified  G^Q^G^1  Is  now  Inserted  Into  the  Kalman  filter 
equations.  The  resultant  controller  formed,  as  a  cascade 
of  a  PI  controller  and  the  Kalman  filter,  should  be  more 
robust  than  the  same  type  controller  without  the  purposeful 
retuning  of  the  filter.  Note  that  when  q  Is  zero,  the 

18  unchanged  and  that,  for  large  (but  finite)  q. 
Equation  <3>8)  might  be  replaced  with  q2B^VB^T  alone. 

3-6  Summary 

This  chapter  briefly  introduced  the  Kalman  filter  and 
discussed  the  negative  effects  of  inclusion  of  the  filter 
on  robustness.  A  methodology  was  Introduced  that  consists 
of  developing  a  highly  robust  full-state  feedback  law  by 
the  Implicit  model  following  techniques  of  the  previous 
chapter,  and  then  recovering  much  of  the  robustness  once  a 
filter  Is  Inserted  Into  the  loop  by  a  specific  form  of 
filter  tuning. 

In  the  next  chapter,  the  methods  of  performance 
analysis  will  be  presented. 


IV.  F-15  PLIGHT  CONTROL  DESIGN 


4-1  Introduction 

In  this  chapter  the  dynaaic  equations  for  the  Short 
Takeoff  and  Landing  (STOL)  F-15  will  be  presented  and  used 
to  assemble  a  truth  aodel  and  the  reduced  order  aodels 
required  for  flight  control  design.  To  allow  for  the  use 
of  battle  damaged  runways*  an  aircraft  aust  have  STOL 
capability.  To  this  end,  it  has  been  proposed  that 
two-diaenslonal  nozzles  be  retro-fitted  to  an  F-15  along 
with  the  addition  of  canards.  The  addition  of  the  thrust 
vectoring  nozzles  and  control  surfaces  provides  an  extra 
degree  of  freedom  to  the  control  engineer  in  his  design  of 
the  control  laws  for  the  aircraft.  This  allows  hla  to 
develop  a  control  system  that  will  minimize  the  approach 
velocity  and  provide  precision  touchdown  capability. 

The  design  of  a  flight  controller  begins  with  the 
aircraft  nonlinear  equations  of  motion*  which  are 
linearized  about  specified  points  in  the  flight  envelope 
and  thus  provide  a  number  of  design  models  which  are 
adequately  characterized  as  linear  and  t ime- invar lant .  The 
data  provided  for  the  design  was  from  the  McDonnell  Douglas 
Aircraft  Corporation  (McAlr)  through  AFWAL/FIGX  1231. 


4-2 

The  data  obtained  from  McAir  was  in  the  form  of  raw 
aerodynamic  data.  This  data  was  entered  into  a  version  of 
the  Conversion  and  Transformation  Program  (CAT)*  developed 
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originally  by  Mr.  A.  Pinley  Barfield  131  for  the  APTI  F-16 
aircraft  and  Modified  by  Capt .  Greg  Mandt*  Lt.  Bruce 
Clough*  and  this  author  to  conform  to  the  control  surfaces 
and  dimensional ity  available  with  the  3TOL  F-15.  A  listing 
of  the  software  code*  now  called  STOLCAT*  and  a 
representative  run  of  the  program  are  given  In  Appendix  B. 
This  program  takes  the  basic  aerodynamic  and  aircraft  data 
and  forms  a  state-space  representation  for  the  system  for 
the  point  about  which  the  equations  of  motion  have  been 
1 1 near l zed . 

For  the  design  of  a  robust  controller  for  the  approach 
and  landing  phase*  the  flight  condition  of  119  knots  (200 
feet  per  second)*  at  sea  level*  with  an  aircraft  gross 
weight  of  33,576  pounds  was  chosen  as  the  equilibrium.  Por 
all  controller  design  and  robustness  checks*  it  was  assumed 
that  the  aircraft  was  known  with  probability  one  to  be  in 
the  appropriate  equilibrium  flight  condition  at  time  t©. 
This  point  Is  especially  important  for  the  covariance 
analysis  as  lt  establishes  the  initial  values  for  the 
covariance  matrix.  It  also  gives  the  initial  conditions 
for  the  Monte  Carlo  studies. 

Por  robustness  studies*  lt  was  necessary  to  obtain  the 
linear  perturbation  models  for  other  points  in  the  flight 
envelope.  These  models  are  used  as  truth  models  In  the 
software  employed  to  evaluate  the  controller  design  and  are 
shown  in  Appendix  C. 


In  the  design  of  a  controller  for  the  specified  flight 
condition,  Modifications  were  required  to  the  state-space 
representation  acquired  from  STOLCAT,  as  the  output  from 
STOLCAT  provides  inputs  fron  each  control  surface  to  each 
state  vector  element.  These  modifications  involved 
achieving  the  proper  dimensions  for  the  control  Input 
matrix  and  specifying  the  output  matrix.  Due  to  software 
limitations,  the  number  of  Inputs  must  equal  the  number  of 
outputs,  and  also  due  to  the  desire  to  keep  the  results  of 
this  study  comparable  to  thesis  efforts  on  the  same  problem 
using  Qualitative  Feedback  Theory  171  and  the  Porter  method 
(11,  a  three- lnput/three-output  system  Is  used.  This  is  a 
restriction  on  design  latitude  that  need  not  be  levied  on 
the  LOG  design  approach  to  this  problem.  The  expected 
result  of  this  restriction  is  a  sub-optimal  controller  when 
compared  to  one  designed  using  a  greater  number  of  Inputs 
and  outputs  (as  Is  seen  In  Appendix  D) . 

The  appropriate  output  variables  for  an  approach  and 
landing  for  a  STOL  aircraft,  or  any  aircraft  where  landing 
roll-out  is  a  critical  factor,  are  flight  path  and 
velocity.  Previous  research  has  determined  that 
controlling  the  pitch  rate  along  with  flight  path  angle  and 
velocity,  yields  a  better  controller  (4,51.  In  this 
design,  these  output  variables  are  to  be  controlled  by  the 
canards,  (tied  aerodynamlcally  to  the  flaps  and  ailerons  to 
limit  the  control  inputs),  the  stabllator,  and  the  reverser 


vanes  In  the  engines.  To  reduce  effects  of  nonlinearities 
and  to  simplify  the  analysis  of  the  controller,  the 
combination  of  the  canards  with  the  flaps  and  ailerons  Is 
done  so  that  an  input  that  would  saturate  a  control  surface 
would  saturate  all  six  surfaces  at  the  same  time.  This  was 
accomplished  by  scaling  the  appropriate  entries  in  the 
control  Input  matrix.  The  procedure  for  this  combination 
and  scaling  are  shown  in  Appendix  E. 

The  resulting  design  model  Is  a  four-state,  time 
Invariant  model  of  the  form 

i  =  Ax  +  Bu  +  w  <  4- 1 ) 

where  the  state  vector  £  has  components 

X{  ■  velocity  (feet  per  second) 

%2  ■  pitch  rate  (radians  per  second) 

X3  ■  pitch  angle  (radians) 

X4  ■  angle  of  attack  (radians) 
and  the  control  Inputs  are: 

uj  ■  canard/ flap/a  1 leron  deflection 
uj  ■  stabllator  deflection 

U3  ■  reverser  vane  deflection  (4-2) 

and  the  elements  of  the  noise  vector  w  are  the  noises 
affecting  the  associated  state  variables.  The  system 


matrices  are 


A 


-6.9009  X  10“2 
-3.6036  X  10“4 
9.2254  X  10“6 
0 


-40.  16 
-0.9913 
0.9796 
1 


0.3352 

1.367 

-0.6392 

0 


-31.54 


0 

-3.233  X  10“2 
0 


<  4-3) 


B 


-1 . 142 
0.8710 

-5.209  X  10-2 
0 


-3.238 

-1.578 

-7.6686  X  10"2 
0 


-21.86 


-2.507  X  10“ 2 
0 
0 


(4-4) 


with  Q*  the  strength  of  the  noise  w,  set  Initially  to  zero. 
The  output  equation  defining  the  variables  over  which 
control  Is  specifically  sought*  is 


Xc*  Cx 

here 


(4-5) 


C  - 


1  0  0  0  * 
0  10  0 

0  0-1  1 


(4-6) 


which  yields  the  outputs  of  velocity*  pitch  rate*  and 
flight  path  angle.  For  this  research*  it  is  assumed  that 
noisy  measurements  of  all  of  the  elements  of  the  controlled 
variable  vector  are  available.  Therefore*  in  the 
measurement  equation 


z  =  Hx  +  v 


(4-7) 


where  the  measurement  matrix  H  is  equal  to  the  ouput  matrix 
C  and  the  strength  of  the  zero-mean*  white  Gaussian  noise 
vector  £  is 


As  sensor  noise  data  for  the  STOL  F-15  was  not  available, 
the  values  above  were  taken  from  Reference  11. 

This  nodel  was  Input  Into  the  computer  aided  design 
tool  developed  by  Floyd  (111  and  Moseley  (251  and  as 
modified  by  Miller  [241.  It  served  as  the  basis  for  the 
controller  design  and  the  Initial  evaluation  of  the 
controller,  as  this  tool  could  only  evaluate  the  full-state 
feedback  controller  or  the  filter  against  the  truth  nodel, 
but  not  the  combination  of  the  controller  and  the  filter. 

4-4  Explicit  Command  Model 

The  function  of  the  explicit  command  nodel  In  this 
application  Is  to  specify  the  desired  handling  qualities 
for  the  aircraft.  From  M11-F-8785C  [21,  the  short  period 
response  in  the  landing  and  approach  phase  should  exhibit  a 
damping  ratio  between  .35  and  1.3  with  a  frequency  range, 
for  the  angle  of  attack  values  Involved,  of  .87  to  4.1 
radians  per  second.  These  values  are  Incorporated  directly 
into  the  explicit  command  model  along  with  the  desire  to 
command  a  zero  net  change  In  velocity  and  pitch  rate. 
Therefore  the  command  nodel  takes  the  form 

Sn  =  AnSn  +  (4-9) 

wl  th 


zm1  =  commanded  velocity 


*■2  *  commanded  pitch  rate 

za3  *  coaaanded  flight  path  angle 

*■4  *  coaaanded  rate  of  change  of  flight  path  angle 


and  with  uB  equal  to  a  unit  step  used  to  define  the  desired 
second-  order  response  in  flight  path  angle.  In  this 


mode  1 ,  A„  and  Ba  are : 


<4-10) 


0 
0 

(4-11) 

0 

16. 

The  coaaanded  output  variables  for  this  application  are  the 
velocity,  the  pitch  rate,  and  flight  path  angle,  with 
velocity  and  pitch  rate  coaaanded  to  zero  and  the  flight 
path  angle  to  follow  the  handling  qualities  character lcs 
specified  above.  This  yields  an  output  equation  of 

1m  *  C»lm  <4-12) 

and 


4-5 


As  was  discussed  in  Chapter  3,  the  purpose  of  the 
implicit  aodel  is  to  enhance  the  robustness  characteristics 
of  the  controller  and,  to  accoapllsh  this,  the  eigenvectors 
of  the  closed-loop  systeM  aust  be  kept  as  orthogonal  as 
possible.  The  lapllclt  control  command  Model  obeys  the 
saae  fora  of  state  and  output  equations  as  the  explicit 
coMMand  Model,  but  with  £«  set  equal  to  the  outputs  of  the 
design  Model,  naaely  velocity,  pitch  rate,  and  flight  path 
angle,  and 


(4-14) 


and  Ba,  Cn,  and  0yR  are  set  to  zero  as  they  have  no  effect 
upon  the  lnpllclt  aodel.  Note  that  the  choice  of  a 
diagonal  An  yields  orthogonal  eigenvectors.  The  values  for 
Mi,  M2,  and  M3  are  deteralned  iteratively  and  have  a  direct 
consequence  on  robustness.  This  iteration  process  will  be 
seen  in  detail  in  the  next  chapter. 


The  initial  truth  aodel  used  for  this  design  problea 
was  siMply  the  design  aodel.  To  test  the  systeM  More 
realistically,  a  nine-state  truth  Model  was  developed  with 
the  additional  states  resulting  froa  the  addition  of 
actuator  dynaalcs.  The  actuators  for  the  canards  and 
stabilators  were  originally  given  as  third  order,  but  an 


analysis  of  the  dynamics  of  the  actuators  (shown  in 
Appendix  E)  using  the  CAD  package  TOTAL  [161,  indicated  no 
significant  difference  between  the  response  using  the  third 
order  actuators  and  a  second  order  approximation.  The 
resultant  truth  model  used  for  controller  evaluation  is 


5t  “  Atlt  +  BtHt  +  Ht  (4-15) 

where  x^i  through  x^4  are  the  original  states  of  the 
system,  xts  and  xt6  are  actuator  states  involving  canard 
deflection,  xt7  and  xt8  are  actuator  states  for  the 
stabllator,  and  xtg  is  for  the  reverser  vanes.  The 
defining  matrices  of  Equation  (4-15)  are: 


All  a12  a13  A 1 4  I  B11 

a2 1  a22  a23  A24  ?  B21 
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a31  a32  a33  a34  |  B31 

a41  a42  a43  a44  *  ®41 


[  B12  0  i  B, 


f  b42 


r  0  1  0  ”  0  1  ~  0 


0000  ^-8356  -303  j 


0  (  0 


0  f 


o  I 

-  H 
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0  '  -8356  -303  I  0 

-  - 1 - 

0  |  0  0  (  -89  I 

(4-16) 


8356 


(4-17) 


8356 


with  2  a  5  i  3  zero  matrix.  As  with  the  design  Model, 
Initially  the  noise  strength,  Qt,  associated  with  wt  was 
set  to  zero.  In  the  At  matrix,  the  values  of  Axx  and  Bxx 
are  the  respective  Matrix  eleaents  of  the  A  and  B  Matrices 
for  the  design  condition,  or  the  appropriate  flight 
condition  in  the  case  of  robustness  tests. 

4-7  Design  Methodology 

The  design  of  the  flight  controller  was  accomplished 
In  several  steps  using  the  CGTPIV  software  that  was 
developed  by  Ployd  [111  and  Moseley  1251  and  Modified  by 
Miller  (241.  The  first  step  involved  developing  a  CGT/PI 
full-state  feedback  controller  without  implicit  model 
following,  but  with  explicit  model  following,  and 
evaluating  the  controller  with  respect  to  an  environment  as 
produced  by  the  design  model.  The  next  step  was  to  Include 
an  Implicit  model  in  the  design  process,  but  still  only 
evaluate  the  resulting  controller  with  respect  to  the 
design  model.  Next  the  controllers  were  tested  against  the 
truth  model  for  the  design  condition,  and  finally 
uncertainty  was  added  to  the  problem  In  the  form  of  the 
dynamics  noise  In  the  system  and  Imperfect  noise-corrupted 
measurements  to  replace  the  artificial  access  to  all 
states.  The  latter  aspect  led  to  the  development  of  the 
Kalman  filter.  The  outputs  from  CGTPIV,  namely  a  CGT/PI 
controller  and  a  Kalman  filter,  were  then  cascaded,  and  the 
resulting  controller  was  evaluated  using  PFEVAL,  a 


covariance  analysis  package  developed  by  Moseley  1251  that 
assuaes  a  linear  truth  model,  and  using  ODEF15,  a 
Modification  of  the  Monte  Carlo  analysis  tool  ODEACT 
developed  by  Miller  1241  that  permits  nonl tnearltles  (as 
particularly  saturations)  in  the  truth  aodel  definition. 

The  actual  designs  and  analysis  will  be  covered  In  detail 
In  the  next  chapter. 

4-8  Summary 

This  chapter  introduced  the  models  used  to  develop  the 
flight  controller  for  the  STOL  F-15.  The  design,  explicit 
command.  Implicit  command,  and  truth  models  were  discussed. 
The  methodology  employed  in  the  design  process  was  outlined 
as  a  preview  for  the  next  chapter. 


V.  ANALYSIS  OF  DESIGN  RESULTS 


5-1  Introduction 

This  chapter  presents  an  analysis  of  the  results  of 
this  study.  The  first  section  deals  with  the  software  used 
to  evaluate  the  designed  controllers.  Then,  the  design 
path  is  presented  in  chronological  order,  with  an  analysis 
of  the  resulting  controller.  Finally,  attempts  at 
robustness  enhancement,  using  the  Doyle  and  Stein  LTR 
technique,  are  discussed. 

5-2  Performance  Analysis  Tools 

The  controllers  designed  in  this  study  were  evaluated 
using  two  software  analysis  tools  developed  in  previous 
AFIT  theses  (and  briefly  introduced  in  Chapter  4).  The 
first  of  these  is  PFBVAL,  an  interactive  software  tool  used 
to  conduct  performance  evaluations  of  linear  sampled-data 
controllers  against  linearized  models  of  realistic 
environments.  The  second  is  a  modification  of  ODEACT,  an 
interactive  program  that  was  originally  written  to  account 
for  actuator  nonlinearities  in  the  simulation  of  the 
real-world  environment  and  to  allow  the  addition  of 
anti -windup  compensation. 

5-2.1  PFEVAL 

PFEVAL  was  written  by  Moseley  125)  to  allow  for  the 


evaluation  of  stochastic  controllers  that  was  not  available 
with  CGTPIF  (ill,  namely  the  evaluation  of  a  filter/ 


controller  cascade  as  tested  against  a  higher  order  *  truth 
Model"  (Fig.  3-2).  To  accomplish  this,  he  amended  CGTPIF 
so  that  data  required  for  performance  evaluation  would  be 
saved  In  the  output  file.  This  output  file  could  then  be 
used  as  a  data  file  In  PFEVAL.  PFEVAL,  with  the  Initial 
covariances  for  the  truth  states  and  control  Inputs 
supplied  by  the  user,  performs  evaluations  of  the 
controller  with  and  without  the  filter  embedded.  The 
output  of  PFEVAL  Is  a  time  history,  for  fifty  sample 
periods,  of  the  standard  deviations  of  all  truth  states  and 
control  Inputs  for  the  controller,  with  and  without  the 
filter,  and  a  list  of  final  estimation  error  covariances  for 
both. 

5-2.2  ODEF15 

ODEF15  Is  a  modification  of  the  nonlinear  simulation 
package  ODEACT,  originally  written  by  Miller  (241.  The 
Initial  version  of  this  program  was  used  to  extend  the 
analysis  of  a  controller,  designed  via  CGTPIF,  to  Include 
nonlinear  effects  generated  by  the  Inclusion  of  actuator 
saturations,  specifically  for  the  AFTI  F-16.  For  the 
purpose  of  this  research,  the  program  was  modified,  and 
renamed  ODEF15,  to  allow  for  the  actuator  saturation 
nonl inearlties  of  the  STOL  F-15,  the  possible  Inclusion  of 
a  Kalman  filter  with  Monte  Carlo  analysis,  and  the  output 
of  CALCOMP  plots.  A  listing  of  the  ODEF15  code  and  a 
sample  run  of  the  program  are  Included  in  Appendix  A. 


The  gain  matrices  for  controllers  and  filters 
designed  with  CGTPIF  are  entered  interactively  into  0DBF15 
along  with  the  cont inuous-tlme  system  matrices  of  Equations 
(4-3),  (4-4),  and  (4-6),  the  discrete-time  1^  and  B<j»  which 
are  outputs  of  CGTPIF,  and  the  strength  of  the  measurement 
noises,  as  given  in  Equation  (4-8).  The  program  is  set  up 
to  perform  interactive  simulation  runs  with  or  without  the 
inclusion  of  the  Kalman  filter,  rate  and  position  limits, 
actuator  dynamics,  and  anti-windup  compensation. 


5-3  Controller  Design 

The  controller  design,  using  CGTPIF,  is  done  in  a 
building  block  fashion.  Initially,  the  state-space 
matrices.  A,  B,  and  C,  of  Equations  (4-3),  (4-4),  and 
(4-8),  are  entered  Into  CGTPIF.  As  the  design  system  is 
unstable,  an  open-loop  CGT  design  is  not  feasible,  so  a  PI 
controller  is  first  designed  and  then  the  closed-loop  CGT. 
This  initial  design  is  accomplished  without  implicit  model 
following  and  is  not  evaluated  against  a  truth  model.  The 
initially  chosen  values  for  the  weighting  matrices  were 
based  upon  the  physical  characteristics  of  the  plant.  In 
the  case  of  the  output  deviation  weights,  since  the  main 
concern  is  for  the  control  of  flight  path  angle,  it  was 
initially  weighted  with  a  coefficient  of  three  as  compared 
to  one  for  the  velocity  and  pitch  rates.  As  the 
canard/f lap/alleron  combination  and  the  stabilator  are 
limited  to  approximately  the  same  amount  of  deflection  from 


the  equilibrium  and  the  reverser  vanes  can  move  almost 
twice  as  much,  the  control  magnitude  weights  are 
Initialized  at  two,  two,  and  one  respectively.  The  control 
rate  weights  are  set  Initially  at  eight  to  four  to  one  for 
the  canard/  flap/aileron  combination,  stabllator,  and 
engine  reverser  vanes  respectively,  as  this  is  the  ratio  of 
the  maximum  deflection  rates  for  these  surfaces.  Another 
choice  for  the  weightings  [201  would  be  to  use  the  square 
of  the  differences  In  "concern,"  position  limits,  or  rate 
limits,  but  as  these  are  only  the  starting  points  for  a 
control  weight  tuning  process,  the  weightings  listed  In 
this  paragraph  are  used.  This  design  yields: 
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In  the  controller  of  Equation  (2-68).  Next,  a  design  of 
the  CGT  Is  pursued  with  the  explicit  model  as  shown  in 
Section  4-4.  This  design  yields: 
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In  the  controller  of  Equation  (2-68),  where: 

*xa  =  KxAll  +  A21  <5-5a) 

KIU  =  KjAj  2  +  A22  (5-5b) 

Printouts  of  the  tlae  response  of  the  output  variables  and 
the  control  deflections  with  the  initial  CGT/PI  full-state 
feedback  controller  are  shown  In  Figures  5-1  and  5-2.  It 
can  be  seen  that  the  flight  path  angle  is  slow,  for  a 
fighter  type  aircraft,  to  attain  the  coaaanded  value  of  a 
five  degree  downward  flight  path.  The  controller  is 
otherwise  well  behaved  as  It  neither  violates  nor 
approaches  any  physical  constraints  of  the  systea.  Further 
Iterations  In  this  step  of  the  design  process  led  to  the 
use  of  the  following  weights  for  the  cost  function  of 
Equation  (2-5):  for  output  deviations,  1:1:25  for  velocity, 
pitch  rate,  and  flight  path  angle,  respectively;  for 
coaaand  input  aagnltude  deviations,  10:3:1  for  the 
canard/f lap/a  1 leron  coabinatlon,  stabllator,  and  reverser 
vanes,  respectively;  and  for  coaaand  input  rate  deviations 
for  the  canard/f lap/alleron,  stabllator,  and  reverser 
vanes,  60:30:1,  respectively.  These  weights  are  to  be  used 
in  the  next  step  in  this  process.  Figures  5-3  and  5-4  show 
a  tlae  history  for  the  output  variables  and  the  control 
deflections  for  this  controller.  This  controller  exhibits 
a  auch  faster  settling  tlae  with  approxiaately  the  saae 
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Figure  5-4.  Control  Deflections  for  Controller  Without 
Implicit  Model  Following 
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amount  of  control  energy  as  the  initial  controller.  This 
performance  is  somewhat  misleading  as  the  controller  is 
being  evaluated  against  a  four-state  "truth  model"  and 
significant  degradation  in  performance  can  be  expected  when 
a  higher  dimension  truth  model  is  used. 

This  next  step  in  the  iteration  is  to  Include  an 
implicit  model  in  the  PI  controller.  The  model  used  is  the 
one  in  Section  4-5  with  the  diagonal  elements  all  set  to 
negative  five  and  the  weights  on  the  derivatives  of  the 
outputs  and  the  control  pseudo-rates  set  to  one.  The 
controller  was  developed  with  the  same  explicit  model  and 
weightings  as  above  with  the  resulting  gain  matrices: 
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Plots  of  the  time  response  of  the  system  outputs  and 
control  Inputs,  now  evaluated  against  the  nine-state  truth 
model  of  Equation  (4-15),  are  shown  for  this  controller  in 
Figures  5-5  and  5-6.  The  addition  of  the  truth  model  to 
the  evaluation  Introduces  the  effects  of  actuator  dynamics 
and  will,  therefore,  have  a  negative  impact  on  system 
response  compared  to  an  evaluation  against  a  'truth  model' 
equated  to  the  design  model.  While  this  controller  shows 
an  Improvement  in  settling  time,  both  position  and  rate 
limits  for  the  canard/flap/aileron  combination  and  rate 
limits  for  the  stabllator  are  violated.  To  alleviate  these 
problems,  the  implicit  model  is  changed  to  reflect  the 
desire  to  slow  down  the  inputs  to  these  control  surfaces, 
which  requires  a  trade-off  in  performance.  The  resulting 
controller  has  the  same  explicit  weighting  matrices  for  the 
performance  index  of  Equation  (2-72a>  as  the  initial 
controller,  with  the  final  implicit  weights  on  output 
derivatives  set  at  1:1:2  for  the  velocity,  pitch  rate,  and 
flight  path  angle,  respectively,  and  the  final  implicit 
control  pseudo-rate  weights  at  2:2:1  for  the 
canard/flap/aileron  combination,  stabllator,  and  reverser 
vanes,  respectively.  The  implicit  command  model  is: 
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The  difference  in  the  last  element  of  An  is  from  the  desire 


to  obtain  a  faster  response  In  flight  path  angle  than  in 
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velocity  or  pitch  rate.  These  values  yield  a  controller 
with  gain  Matrices  of: 

".024718  4.532  -12.55  .072426  “ 

Kx  *  .027933  -10.94  27.59  -.1744  (5-11) 

.-3.404  1.466  -1.328  .020731. 

"-.0031405  .5861  .3119 

Kz  =  .011646  -1.405  -.6242  (5-12) 

-.083988  .089413  .034607. 


.024932  -12.04  -.038514  -.04804 

.027922  26.81  .5866  .1083 

-3.407  -4.205  -1.513  -.011917 

1.140 
-2.578 
.2606 

Tine  response  plots  for  this  controller,  given  a  five 
degree  nose-down  flight  path  angle  coaaand,  are  shown  in 
Figures  5-7  and  5-8.  This  controller  provides  a  reasonable 
settling  tlae  with  a  very  Mild  overshoot  and  violates  none 
of  the  physical  constraints  laposed  upon  the  systea.  As 
this  design  satisfies  the  desire  for  perforaance  without 
violating,  or  approaching,  the  llalts  of  the  systea,  it  Is 
used  for  the  analysis  to  follow. 

It  is  at  this  juncture  that  the  assuaptlon  of 
full -state  feedback  is  replaced  with  the  aore  realistic 


(5-14) 


(5-13) 
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Figure  5-7.  Output  Variables  for  Final  Controller 


FINAL  CONTROLLER 


0.00 

3 

+ 

+ 

4 

2  1 

+ 

.20 

+ 

+ 

3 

2 

4 

+  1 

4 

.  40 

+ 

3  + 

+ 

+  1 

+  2 

+ 

.60 

+ 

+ 

3 

♦ 

+  1 

+  2 

+ 

.  80 

+ 

+ 

+ 

3 

+  2 

4 

4 

I  .00 

+ 

+  1 

2 

+  3 

♦ 

4 

1  .  20 

+ 

+ 

2  ♦ 

4 

3 

4 

1 .40 

2 

1 

♦ 

4 

♦  3 

4 

1.60 

+  2 

+ 

l 

+ 

4 

+  3 

4 

1 .80 

♦  :  2  :  : 

:  1  + 

:  :  : 

*  •  +  •  • 

:  : 

:  4 :  :  :  : 

: +3  :  :  : 

:  4 

2.00 

+  2 

1  + 

+ 

4 

3  + 

+ 

2.20 

2  1 

♦ 

+ 

+  3 

4 

+ 

2.40 

+  2  1 

+  3 

+ 

+ 

2.60 

♦  2 

+ 

+ 

+  3 

4 

+ 

2.80 

+  12 

+ 

+ 

3 

4 

3.00 

+ 1  2 

♦ 

+ 

3  + 

4 

+ 

3.20 

+  1 

2  + 

+ 

3 

4 

4 

+ 

3 . 4n 

+  1 

2  ♦ 

+ 

3 

4 

4 

3.60 

+  1 

2  + 

+ 

3 

4 

4 

+ 

3.80 

+  1  :  : 

:  2  + 

:  :  : 

:  :  + :  : 

3  : 

:  4 :  :  :  : 

:  4 :  :  :  : 

:  + 

4.00 

+  1 

2 

+ 

3 

4 

+ 

+ 

4.20 

+  1 

+  2 

+ 

3 

♦ 

4 

+ 

4.40 

+  1 

+ 

2 

+ 

3 

+ 

4 

+ 

4.60 

+  1 

+ 

2 

+ 

3 

+ 

4 

+ 

4.80 

+  l 

+ 

2 

+ 

3 

+ 

4 

♦ 

5.00 

+  1 

+ 

2 

♦ 

3 

+ 

♦ 

+ 

5.20 

+  1 

+ 

2 

+ 

3 

+ 

4 

+ 

5.40 

+  1 

+ 

2 

+ 

3 

4 

♦ 

+ 

5.60 

+  1 

+ 

2 

+ 

3 

4 

♦ 

+ 

5.80 

+ :  l :  : 

:  :  + 

:  :  2 : 

:  :  + :  : 

3  : 

:  + :  :  :  : 

:  + :  :  :  : 

:  + 

6.00 

+  1 

+ 

2 

+ 

3 

+ 

4 

+ 

6 . 20 

+  1 

+ 

2 

3 

4 

4 

+ 

6.40 

+  1 

+ 

2 

+ 

3 

+ 

4 

+ 

6 . 60 

*  1 

+ 

2 

♦ 

3 

4 

4 

+ 

6.80 

+  l 

+ 

2 

+ 

3 

+ 

4 

+ 

7.00 

+  1 

+ 

2 

+ 

3 

4 

4 

7 . 20 

+  1 

2 

4 

3 

4 

4 

+ 

7 . 40 

+  1 

+ 

2 

4- 

3 

♦ 

4 

+ 

7.60 

+  1 

+ 

2 

+ 

3 

4 

4 

4* 

7.80 

+ :  1  : 

:  :  * 

:  2  : 

:  :  + :  : 

3  : 

:  + :  :  :  : 

:  4 :  :  :  : 

:  4- 

8.00 

+  1 

+ 

2 

4 

3 

4 

♦ 

4- 

8 . 20 

+  1 

2 

4 

3 

4 

4 

4* 

8.40 

+  1 

2 

4 

3 

+ 

4 

4- 

8.60 

+  1 

+ 

2 

4 

3 

4 

4- 

4* 

8.80 

+  1 

+ 

2 

4 

3 

♦ 

4 

4“ 

9.00 

+  1 

+ 

O 

tm 

4 

3 

+ 

4 

4- 

9.20 

+  1 

+ 

2 

♦ 

3 

♦ 

4 

+ 

9 . 40 

♦  1 

+ 

2 

4 

3 

4 

♦ 

4- 

9.60 

+  1 

f 

2 

4 

3 

+ 

4 

+ 

9.80 

+ :  1  : 

:  :  + 

:  2  : 

:  :  * :  : 

3  : 

:  + :  :  :  : 

:  4 :  ;  :  : 

:  4- 

10.00 

+  1 

+ 

2 

+ 

3 

4 

4 

4* 

SCALE  1 

- . 2600 

2000 

- . 1 400 

-  .0800 

-  .0200 

•  040i 

SCALE  2 

-  .  1600 

1  200 

-.0800 

- . 0400 

.0000 

.0401 

SCALE  3 

0.0000 

.0400 

.0800 

.  1200 

.  1600 

.2001 

Figure  5-8.  Control  Deflections  for  Final  Controller 


assumption  of  Incomplete/ Imperfect  measurements  and  the 
addition  of  a  Kalman  filter.  For  this  purpose  the 
measurement  matrix  H  and  the  sensor  noise  matrix  R,  shown 
in  Section  4-3,  are  included  in  the  design  model  (and  also 
in  the  truth  model).  In  addition,  the  G  and  matrices 
are  included  in  the  design  and  truth  models,  respectively. 
In  both  cases  they  are  identity  matrices  of  the  appropriate 
dimension.  Initially,  noises  are  associated  with  the  angle 
of  attack  and  pitch  rate  and  their  strengths  are  set  to 
unity  as  a  first  guess,  and,  after  numerous  Iterations 
between  CGTPIF  and  ODEF15,  to  attain  the  desired 
performance  both  took  on  the  value  of  .0001.  With  these 
additions  to  the  design  and  truth  models,  it  is  possible  to 
design  and  evaluate  a  Kalman  filter  using  CGTPIF.  After  a 
number  of  Iterations  to  attain  good  estimation  precision 
and  controller  performance  at  "on-design"  conditions,  the 
CGT/PI/KF  controller  to  be  used  as  a  baseline  in  the 
f 1 l ter- in-the-loop  robustness  enhancement  studies  was 
derived.  The  controller  of  Equations  (5-10)  through 
(5-14),  with  final  Kalman  filter  gains  of: 


Kp  = 


6153 

-.1122 

.0019542 

2875 

.  1958 

-.0072972 

02827 

.0221 

-.2300 

015051 

.0023899 

-.21043 

is  to  be  evaluated  with  PFEVAL  and  0DEF15  against  a  number 
of  varying  real-world  conditions. 


5-4  Performance  Analysis 

The  controller  developed  In  the  previous  section  Is 
analyzed  In  detail  in  this  section.  First,  a  linear 
covariance  analysis  Is  accomplished  using  PFEVAL.  Then, 
the  nonlinear  simulation  program,  ODEF15,  Is  used  to  test 
the  control  laws  against  a  more  realistic  environment 
including  actuator  saturations.  Finally,  LTR  tuning  Is 
used  In  an  attempt  to  recover  some  of  the  robustness  lost 
In  going  from  full-state  feedback  to  the  controller  with  a 
Kalman  filter  In  the  loop. 

The  results  of  the  covariance  analysis  at  the  final 
simulation  time  are  presented  In  Table  5-1  and  show  that 
the  Inclusion  of  the  filter*  with  state  estimates  updated 
with  the  Incoming  measurements.  Improves  the  performance  of 
the  controller.  This  Is  not  a  totally  unexpected  result,  as 
the  truth  model  against  which  the  controller  Is  being 
evaluated  Includes  actuator  dynamics  (see  Section  4-6),  and 
therefore  Involves  effects  not  modelled  In  the  design  of 
the  controller;  If  the  truth  model  were  the  same  as  the 
design  model,  the  full -state  feedback  design  would 
naturally  outperform  the  design  model  with  the  filter  In 
the  loop. 
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Table  5-1 


Final  Standard  Deviations  of  CGT/PI/KF  Controller  Design 


STANDARD  DEVIATIONS  (r  II 

A  RADIANS  OR  RADIANS/SEC) 

TRUTH 

STATE 

WITH  FILTER 

WITHOUT  FILTER 

U 

4.9617264  X  10"3 

4. 165973  X  10“3 

q 

1.2784801  X  10"2 

1.3747698  X  10“2 

a 

1.1799363  X  10“2 

1.2151774  X  10‘2 

e 

7.0565759  X  10‘3 

7.5290352  X  10‘3 

*cfa 

2.1194026  X  10-2 

2.8109224  X  10“2 

*cfa 

3.3509912  X  10“l 

4.4106762  X  10'1 

5.1844835  X  10”2 

6.8388985  X  10“  2 

's 

7.6988819  X  10”1 

1.0284194 

*rv 

3. 1738364  X  10“2 

3.3501037  X  10-2 

*cfal 

2.5876006  X  10“2 

3.4182074  X  10“2 

*sl 

6. 1941621  X  10"2 

8.1942491  X  10“ 2 

drvl 

3.2065578  X  10’2 

3.3686558  X  10“2 

5-4.1  Nonlinear  Performance  Analysis 


The  robustness  evaluation  of  the  controller  using 
ODEF15  is  done  in  four  segments.  In  the  first  section,  the 
controller  is  tested  using  the  design  flight  condition  with 
actuator  dynamics,  l.e.,  a  nine-state  truth  model,  and  rate 
and  position  limits  considered.  As  the  controller  is 
designed  for  a  five-degree  nose-  dovn  flight  path  angle. 


this  is  the  first  condition  tested.  The  full-state 
feedback  response  and  the  response  with  the  inclusion  of  a 

a 

Kalman  filter  based  on  x<ti+)  are  shown  in  Figures  5-9  and 
5-10  respectively.  These  responses  for  the  full-state 
feedback  case  are  similar  to  those  obtained  when  the  full- 
state  feedback  controller  was  evaluated  against  the  nine- 
state  truth  model  in  CGTPIF  and,  as  the  controller  is 
designed  to  avoid  the  rate  and  position  limits,  this  is  to 
be  expected.  As  the  measurements  of  the  outputs  are  very 

a 

accurate,  the  results  for  x(ti+>  are  expected  to  be  close 
to  that  of  full-state  feedback,  and  this  in  fact  occurs,  as 
is  seen  in  a  comparison  of  the  plots  for  the  respective 
outputs.  It  should  be  noted  that  the  differences  in 
velocity  are  actually  very  small  when  compared  with  the 
flight  velocity  of  200  feet  per  second  and  that  the 
apparent  divergence  occurs  well  out  of  the  time  period  of 
Interest,  approximately  six  seconds.  There  is  also 
significantly  more  control  energy  used  with  the  Kalman 
filter  than  with  the  full-state  feedback  case.  This  is  due 
to  the  estimation  of  state  variables,  the  inclusion  of 
actuator  dynamics  in  the  truth  model,  and  the  resulting  lag 
in  control  application.  The  results  for  a  controller  based 
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on  £<ti“)  are  not  shown  here,  nor  will  they  be  shown  in 
this  research.  This  is  because,  in  order  to  stabilize  the 
controller,  a  value  for  Q  was  so  small  as  to  make  the 
problem  physically  meaningless.  This  may  be  Interpreted  as 
the  filter  having  almost  no  confidence  in  the  dynamics 


model  and  putting  extremely  heavy  weight  on  the  Incoming 
measurements.  While  the  measurements  for  this  study  are 
very  accurate.  It  Is  Imprudent  to  Ignore  the 
embedded  dynamics  model  completely.  It  is  therefore  decided 

a 

to  eliminate  x<tj")  from  consideration  in  this  problem,  but 
with  this  In  mind,  a  computationally  efficient  algorithm 
for  the  controller  must  be  used.  This  algorithm  must 
minimize  the  destabilizing  delay  between  the  incoming 
measurement,  z(tp,  and  the  output  of  a  control  signal, 
u(t}>,  and  the  total  time  for  the  computation  must  also  be 
less  than  the  sample  period  of  the  system. 

The  second  block  of  evaluation  was  for  Inputs  other 
than  for  what  the  controller  was  designed.  For  this  and 
all  subsequent  evaluations,  the  controller  with  the 
filter-in-  the-loop  is  considered.  First,  a  shallower 
flight  path  angle  (three  degrees)  was  commanded.  The 
results,  shown  in  Figure  5-11,  indicate  that  the  controller 
Is  capable  of  complying  with  this  command.  Another 
analysis  is  done  with  the  aircraft  in  equilibrium  with  a 
minus  five  degree  flight  path  angle.  In  this  case,  a  five 
degree  pitch  up  command  is  given,  and  as  seen  in  Figure 
5-12,  the  controller  has  no  difficulty  with  this  task. 

Next,  system  failures  are  simulated  by  first 
Increasing  the  sensor  noises  and,  secondly,  simulating  the 
loss  of  an  actuator.  For  the  section,  sensor  degradation  is 
simulated  by  a  two-order-  of-magnltude  increase  in  sensor 
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noise  In  the  truth  model  without  giving  the  filter  an 
Indication  of  the  change.  As  is  demonstrated  In  Figure 
5-13,  this  noise  increase  has  the  effect  of  causing 
oscillations  about  the  nominal  values,  but  is  not 
destabilizing  at  this  magnitude.  It  exhibits 
characteristics  similar  to  the  filter  with  non-degraded 
sensor  data,  i.e.  similar  to  the  full-state  feedback  case 
in  flight  path  angle,  but  more  oscillatory  in  velocity  and 
pitch  rate  and  with  more  active  control  surfaces.  The 
second  system  failure  to  be  simulated  is  that  of  a  canard 
failure.  It  is  assumed  that  the  canard  is  free-floating 
and  contributes  nothing  to  the  moment  generation  required 
to  pitch  the  aircraft.  This  is  accomplished  by  zeroing  out 
the  command  to  the  canard/f lap/al leron  combination  in 
ODEF15.  This  slows  the  system  down  and  also  eliminates  the 
overshoot  seen  in  the  case  of  a  healthy  system.  Figures 
5-14  and  5-15  depict  the  results  of  a  five  degree  pitch 
down  and  a  five  degree  pitch  up  to  level-off,  respectively, 
which  can  be  compared  to  Figures  5-10  and  5-12.  There  Is 
very  little  degradation  in  the  flight  path  angle  for  either 
case,  just  slightly  slower  as  was  indicated  above,  and  the 
other  outputs  and  control  deflections  become  more 
oscillatory  in  the  face  of  the  failure.  This  indicates  a 
great  deal  of  robustness. 

In  the  final  section  of  the  performance  evaluation, 
the  controller  is  tested  against  off-deslgn  flight 
conditions.  This  has,  to  some  degree,  already  been  done, 
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as  the  controller  has  been  evaluated  against  a 
truth  model  of  higher  order  than  the  design  model.  The 
controller  designed  for  a  specific  flight  condition  does 
not  perform  as  well  at  off-deslgn  points  of  the  flight 
envelope.  This  Is  not  a  major  concern,  as  In  practice,  gain 
scheduling  would  be  used  for  variations  Inflight 
conditions,  but  It  Is  a  good  check  for  robustness. 
Simulations  using  the  controller  designed  In  this  study 
versus  the  aircraft  model  for  a  slower  true  airspeed 
(Vain),  for  a  higher  density  altitude  at  the  original 
airspeed,  and  for  an  Increased  gross  weight  at  the  original 
airspeed  and  altitude  are  shown  in  Figures  5-16,  5-17,  and 
5-18,  respectively.  As  was  mentioned  earlier,  this 
controller  suffers  from  degraded  performance  at  the 
off-deslgn  conditions,  which  Is  shown  by  the  Increased 
variance  In  the  velocity  and  pitch  rate  and  the  Increased 
control  activity  required  for  the  manuever  compared  to  that 
for  the  baseline  controller  with  the  Kalman  filter  <Flg. 
5-10).  Again  note  that  the  undulations  In  velocity  are 
very  small  when  compared  to  flight  velocity.  Attempts  will 
be  made  In  the  next  section,  via  LTR,  to  improve  this 
performance . 

5-5  Kalman  Filter  Tuning 

In  this  section  the  Doyle  and  Stein  LTR  technique  Is 
applied  to  the  controller  in  an  attempt  to  enhance 
robustness.  As  a  slight  modification  to  this  method,  q^BVB^ 
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replaces  Q0.  For  this  study,  the  q2  term  was  set  to  .0001, 
and  the  technique  was  used  on  one  of  the  off-design 
conditions  and  for  the  case  with  a  three  order-of- 
aagnltude  Increase  in  sensor  noise.  The  initial  prospects 
for  robustness  enhanceaent  with  this  aethod  were  not 
proalslng,  as  the  systea  has  a  right-half-plane 
transaission  zero  (181  and  Is  a  saapled-data  PI  controller 
rather  than  a  contlnuous-tlae  proportional  gain  regulator. 
Separately,  each  of  these  conditions  reaoves  the  guarantees 
associated  with  the  robustness  laproveaent  to  be  gained  by 
the  Ooyle  and  Stein  technique  (281. 

First  the  controller  with  the  filter  tuned  via  LTR  is 
evaluated  at  the  flight  condition  for  which  the  controller 
was  designed.  The  results  of  this  slaulatlon,  seen  In 
Figure  5-19,  show  significant  laproveaent  in  all  channels 
over  the  baseline  controller  with  the  Kalaan  filter  in  the 
loop  (Fig.  5-10),  and  approach  the  perforaance  of  the 
full-state  feedback  controller  (Fig.  5-9).  Once  again, 
this  result  is  expected  because  of  the  Increased  order  of 
the  truth  aodel  used  in  the  evaluation,  coapared  to  the 
order  of  the  design  aodel.  If  this  design  were  to  be 
evaluated  against  the  design  aodel  rather  than  the  higher 
dlaensioned  truth  aodel,  LTR  tuning  would  be  off-noalnal 
tuning  at  design  conditions,  and  would  be  expected  to  cause 
perforaance  degradation  at  the  design  conditions. 

Next  the  controller  is  evaluated  against  a  flight 
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condition  with  a  10,000  foot  altitude.  With  the  original 
Kalaan  filter  at  the  10,000  foot  altitude  (Fig.  5-17), 
there  are  significant  oscillations  in  both  the  velocity  and 
pitch  rate,  but  with  the  LTR-tuned  filter  (Fig.  5-20)  these 
oscillations  are  smoothed  out  and  there  is  less  overshoot 
in  the  flight  path  angle,  along  with  a  reduction  in  the 
level  and  undulations  of  the  control  inputs:  a  definite 
improvement  in  the  performance  of  the  controller. 

The  controller  with  the  LTR-tuned  filter  is  then 
evaluated  with  the  aircraft  gross  weight  Increased  by 
approximately  10,000  pounds.  The  results  of  this 
simulation  are  shown  in  Figure  5-21  and,  as  in  the 
preceding  case,  a  marked  improvement  over  the  performance 
of  the  untuned  filter  (Fig.  5-18)  is  exhibited.  Once 
again,  this  improvement  occurs  in  all  channels  of  interest, 
with  the  smoothing  of  the  velocity,  pitch  rate,  and  control 
input  responses  the  most  noticeable. 

In  the  case  of  a  large  Increase  in  sensor  noises 
(Figure  5-22),  the  controller  is  unstable  with  the  original 
filter  and  is  stabilized  with  the  change  to  the  LTR-tuned 
filter  (Figure  5-23),  although  it  displays  very  poor 
performance.  This  enhanced  stability  would  be  Important, 
as  keeping  the  aircraft  stable  in  the  face  of  a  massive 
sensor  failure  would  allow  online  adaptation  to  occur,  or 
at  least  provide  the  pilot  time  to  make  an  escape. 
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5-6  aaai frrr 

In  this  chapter,  the  aethods  used  for  perforaance 
analysis  are  discussed,  and  then  the  steps  taken  In  the 
developaent  of  a  CGT/PI/XF  controller  are  detailed.  The 
resulting  controller  is  then  analyzed  using  the  procedures 
froa  the  beginning  of  the  chapter  and  rather  successful 
atteapts  aade  for  robustness  enhanceaent  In  the  face  of 
changing  flight  conditions  and  sensor  degradation.  In  the 
next  chapter,  conclusions  of  this  study  and  recoaaendat Ions 
for  future  research  will  be  presented. 
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CONCLUSIONS  AND  RECOMMENDATIONS  FOR  FURTHER  STUDY 


6- 1  Conclusions 


The  goal  of  this  study  has  been  to  design  a  robust 
LQG/LTR  flight  contoller  for  the  STOL  F-15  for  the  approach 
and  landing  phase  of  flight.  This  has  been  accomplished  by 
the  use  of  implicit  model  following  and  Loop  Transfer 
Recovery  (LTR)  techniques  with  a  Command  Generator 
Tracker/Proportional  plus  Integral  controller  with  a  Kalman 
filter  In  the  loop  (CGT/PI/KF). 

The  LOG  design  methodology  provides  the  designer  with 
a  systematic  way  to  approach  the  design  problem.  Through 
the  use  of  the  command  generator  tracker  (CGT),  the 
designer  can  incorporate  the  desired  handling  qualities  to 
be  mimicked  and  the  disturbances  to  be  rejected.  Implicit 
model  following  allows  the  designer  to  include  information 
about  the  handling  qualities  directly  into  the  performance 
index  and  also  to  affect  the  pole  placement  of  the  system. 
The  "type-1’  property  of  the  PI  controller  allows  for 
tracking  of  a  zero  input  with  a  nonzero  steady-state 
control,  despite  unmodelled  constant  disturbances.  The 
Kalman  filter  provides  estimates  of  the  states  from  the 
noise-corrupted  and  Incomplete  outputs  of  sensors.  The  use 
of  implicit  model  following  allows  for  the  design  of  a 
robust  full-state  feedback  controller  and,  then  LTR  tuning 
of  the  filter  allows  for  the  recovery  of  some  of  that 
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robustness  lost  from  the  inclusion  of  a  Kalman  filter  in 
the  control  loop. 

One  of  the  major  benefits  of  LQG  controller  design  is 
that  the  designer  is  provided  with  insights  as  to  the  next 
step  In  each  iteration.  These  insights  result  from  the 
individual  weightings  placed  in  the  performance  index  and 
from  the  assumed  characteristics  of  the  explicit  and 
implicit  models.  For  example,  if  a  certain  control  surface 
exceeds,  or  even  approaches,  a  limit  during  an  iteration, 
the  designer  knows  to  Increase  the  weight  on  that  element 
in  the  performance  index  on  the  next  run. 

The  fact  that  LTR  tuning  yielded  an  Improved 
controller  was  somewhat  unexpected,  as  the  system  is 
non-minimum  phase  and  includes  a  PI  controller  rather  than 
a  proportional  gain  regulator.  The  type  of  the  change  in 
performance  was  also  not  predicted:  not  only  is  the 
controller  more  robust,  it  also  performs  better  at  the 
design  condition,  contrary  to  the  normal  trade-off  between 
performance  at  design  conditions  and  robustness  at 
off-design  conditions. 

The  major  drawback  to  the  use  of  LQG/LTR  design  is 
the  lack  of  an  Integrated  design  and  analysis  software 
package.  Currently,  three  separate  pieces  of  software  must 
be  used  to  design  and  evaluate  a  controller  completely. 

Two  of  the  codes,  CGTPIF  and  PFEVAL,  are  written  in  FORTRAN 
IV  and  are  sem l -compat ible .  To  use  a  file  generated  by 
CGTPIF  in  PFEVAL,  one  must  exit  CGTPIF,  save  the  file. 


rename  the  file  as  a  data  file#  and  then  run  PFEVAL.  To 


use  ODEF15#  a  FORTRAN  V  code#  one  must  attach  two  separate 
libraries  and  enter  the  system  matrices#  In  both  continuous 
and  discrete-time  form,  and  the  gain  matrices  from  CGTPIF# 
manually.  This  can  be  time-consuming  and  is  not  efficient 
in  the  use  of  computer  resources. 

6-2  Recommendations  for  Further  Study 

The  number  one  recommendation  for  future  research  was 
addressed  in  the  previous  section.  An  integrated  design 
package  is  needed  to  make  the  study  of  LQG/LTR  design 
theory  more  practical  for  the  design  of  a  CGT/PI/KF 
controller.  This  design  tool  could  be  built  around  one  of 
the  state-of-the-art  computer  aided  design  (CAD)  packages# 
such  as  MATRIX  X  118],  and  should  be  hosted  on  an  AFIT 
computer,  preferably  the  VMS  VAX.  Using  an  integrated  CAD 
package  has  the  advantage  of  built-in  routines  for  Kalman 
filtering,  singular  value  and  transmission  zero  solutions# 
along  with  many  other  features  of  which  the  designer  could 
take  advantage . 

Another  topic  for  extended  research  would  be  to 
derive  the  proper  LTR  technique  for  a  filter  with  a  PI 
controller.  Current  research  has  derived  LTR  for  the 
regulator  and  this  study  indicated  that  form  of  LTR  to  be 
beneficial  to  a  PI  controller,  but  there  is  currently  no 
physical  or  mathematical  foundation  for  the  use  of 
regulator  LTR  with  the  PI  controller  structure. 


Finally,  the  applicability  of  structured  singular 
values  (21]  to  the  LQG/LTR  design  problem  should  be 
investigated  further.  Unstructured  singular  values  were 
previously  shown  to  be  of  little  benefit  to  design  insight 
1241,  but  structured  singular  values  may  be  able  to  bound 
the  performance  and  sensitivity  of  the  controller,  and 
thereby  provide  the  designer  with  very  pertinent 
information  for  the  synthesis  of  robust  controller  designs 
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APPENDIX  A.  QDEF15 


fi: 


A-l  Introduction 

ODEF15  is  an  interactive  computer  program  that  was 
developed  originally  by  Capt .  W.  G.  Miller  [241  and 
modified,  as  detailed  in  Chapter  5,  for  this  study.  ODEF15 
is  a  nonlinear  simulation  tool  that  provides  for  the 
possible  inclusion  of  a  Kalman  filter,  actuator  dynamics 
and/or  saturations,  rate  and  position  limits,  and  the 
addition  of  anti-windup  compensation.  This  appendix 
gives  a  brief  description  of  the  program  and  instructions 
for  its  use.  A  list  of  the  computer  code  and  a  sample 
program  execution  are  also  given. 


P  «' 


a-2  Program  EascMtlsn 

The  original  program,  ODEACT,  was  designed  only  for  the 
evaluation  of  a  full-state  feedback  CGT/PI  controller  for 
the  AFTI/F-16  [241.  ODEF15  has  been  modified  to  allow  for 
the  possible  addition  of  a  Kalman  filter  and  is  specific 
for  the  STOL  F-15.  To  incorporate  a  Monte  Carlo  analysis 
in  the  program,  the  IMSL  library  is  invoked,  for  random 
number  generation,  as  well  as  the  integration  package  ODE. 
Both  of  these  libraries  are  available  on  the  ASD  CDC  Cyber. 

Prior  to  entering  0DEF15,  all  previously  developed  data 
files  that  are  to  be  used  must  be  attached,  along  with  the 
IMSL  and  ODE  libraries.  IMSL5  and  ODE  must  be  declared  as 
libraries  before  execution  begins.  The  program  will  prompt 
the  user  for  all  required  entries.  During  the  initial 
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execution,  the  user  will  be  prompted  to  enter  all  required 
matrices.  The  user  must  be  cautious  when  a  Kalman  filter 
is  evaluated,  as  there  Is  no  built-in  protection  against 
accidentally  entering  a  very  large  number  of  iterations  In 
the  Monte  Carlo  analysis.  All  of  the  time-response  plots 
displayed  at  the  user's  terminal  can  be  routed  to  a  line 
printer,  or  saved  to  a  file,  upon  program  termination. 

Plot  files  for  the  CALCOMP  plotter  are  also  generated  by 
the  program  and  can  also  be  saved  or  plotted  as  desired. 


PROGRAM  ODEF1S 


C  SIMULATION  PROGRAM  TO  TEST  A  PI  OR  CGT/PI,  WITH /WITHOUT  KALMAN 
C  FILTER,  GAGED  ON  A  4-STATE  MODEL  OF  THE  STOL  F-1S.  OPTIONS 
C  INCLUDE  MODIFICATION  OF  DYNAMICS  MATRIX,  USE  OF  2-8TATE 
C  ACTUATOR  MODELS,  APPLICATION  OF  RATE /POSITION  LIMITS  ON  ACTUATORS, 

C  AND  EMPLOYMENT  OF  ANTI-WINDUP  COMPENSATION.  UGER  SUPPLIES  DYNAMICS 
C  MATRIX,  OUTPUT  MATRIX,  C8T  COMHANO  MODEL,  CONTROLLER  GAINS  AND 
C  KALMAN  FILTER  MATRICES. 

C 

C  DATE  OF  LA8T  REVISIONi  01  NOW  85 
C  LIBRARIES  USEDl  ODE, IHGLS 


REAL  WORK(332),X(12),DX(12),OUT(51,4),T,TOUT,T8AHP,PLTVEC(2GO) 
REAL  XTEHPU2) 

REAL  AH0RK(4, 4) , BUORK (4, 4> , CWORK <4, 4) , AM(4, 4) , BH<4, 4) , Z C3> 

REAL  IPHIX(4,4) 

REAL  RELERR,ABGERR,D6IHt0UTi(51,S>,U0UT2(Sl,4>,U0UT3(3i,S>,Y(4) 
REAL  V(3),EVTHP(2) 

INTEGER  NR,Hm,JJJ 
DOUBLE  PRECISION  DSEED 

INTEGER  I,J,K, IFLA8, JFLA8, JCFLA8,NFLA8, IW0RK(3>, ID6IH 
INTEGER  MHFLA6  IIFLA6 

COMHON/HATRI X/U0(2) , AC12, 12) , CC4, 12) , KX (4, I2> , KZ (4,4), KXH(4, 4> , 
1  KXU<4,4)  ,PHI  (4,4)  ,PHINT(4,4),CM(4,4)  ,B<3,3>  ,EV<2)  ,KFLA6,HM 
C0HH0N/C0NTRL/UNEW(4),U0LD(4),UCHD(4>,UC0LD(4),X0LD(12>, 

1  XMQLD(4) , XM(4), MFLA8, EVA (2) , 

1  H(3, 4) , PHIX (4, 4) , BDC4, 3) , OD  <4, 4) ,RC3, 3) , XHPC4) , XHH(4> , K  <4, 3) 
EXTERNAL  F1,F3,F4,FST0L 

CHARACTER  ANBU*1,TZTL£*90,DATA*6,BAS€**,FL0T*6 


C  INPUT  SECTION.  DATA  HAY  BE  READ  IN  FROM  AN  ’OLD*  FILE,  AND  SAVED 
C  TO  ANY  OTHER  FILE.  ONLY  ONE  GET  OF  DATA  PER  FILE  NAME.  PLOTS  ARE 
C  AUTOMATICALLY  8AVED  IN  A  'PLOT  FILE'. 


PRINT*,'  INCORPORATE  KALMAN  FILTER?  Y/Ni' 
READCt, ' (A)' )  ANBU 

IF  (ANGU. ME. ' Y' . AM). AN8U. NE. ' N' )  GO  TO  2C 
IF  (ANBU.EB. 'Y')  IIFLAG-1 
IF  (ANBU. EG. 'N')  IIFLAG-0 
PRINT*, 'DATA  TO  BE  READ  FROM  FILE?  Y/Ni  ' 
READ(«, ' (A) ' ) ANSW 

IF(ANBU.NE. 'Y'. AND. ANEW. NE.'N' )  GO  TO  902 


IF(ANSH.EQ.'N’)  60  TO  30 
JCFLA6-0 

PRINT*, ’ENTER  NAME  OF  DATA  FILE*  ’ 

READ(t, * (A)' > DATA 

0FENC2, FILE-DATA, STATUS-* OLD» , FORM-’ UNFORMATTED’ ,ERR«902) 
READ<2) <<A(I, J), 1-1, 12) , J-l, 12) 

READ(2)((Bd,J),  1-1,3),  J-1,3) 

READ (2) ( (C(I, J) , 1-1,4) ,J-1, 12) 

R£AD(2)((KXd,J),  1-1,4),  J-l,  12) 

READ <2) < <KZ ( I , J) , 1-1 , 4) ,  J-l , 4) 

READ(2)((KXUd,J),  1-1,4),  J-1,4) 

READ (2) ( (KXM( I , J) , 1-1 , 4) , J-l , 4) 

READ (2) ( (AM( I , J) , 1-1 , 4) , J-l , 4) 

READ(2) ((BH(I, J), 1-1,4), J-l, 4) 

READ(2)((CMd,J),  1-1,4),  J-1,4) 

IF(I IFLA8.EQ.0)  60  TO  901 
READ(2) ((PHIX( I, J), 1-1,4), J-1,4) 

READ(2)((BD(I, J), 1-1,4), J-l, 3) 

READ(2)((QDd,J),  1-1,4),  J-1,4) 

READ(2) (<H(I, J), 1-1,3), J-1,4) 

READ(2)((K(I, J), 1-1,4), J-l,3> 

READ(2) ( <R< I , J) , 1-1 , 3) , J-l, 3) 

901  CONTINUE 

REUINDC2) 

CLQ8E(2) 

60  TO  140 
C 

C  FOR  KEYBOARD  INPUT,  ONLY  NON-ZERO  MATRIX  ELEMENTS  ARE  REQUIRED. 

C  NO  NON-ZERO  ENTRIES  SHOULD  BE  MADE  FOR  COLUMNS  5,6,7,9,10  OR  11 
C  OF  A  OR  KX,  BUT  NO  PROTECTION  PROVIDED  AGAINST  DOING  SO. 

C 

30  DO  50  1-1,12 

DO  SO  J-l, 12 
A(I,J)-0.0 
50  CONTINUE 
DO  42  1-1,3 
DO  42  J-l, 3 

R(I,J)-0.0 
B(I,J)-0.0 
42  CONTINUE 

DO  64  1-1,12 
DO  60  J-1,4 
KX (J, I)-0.0 
60  CONTINUE 

DO  64  L-1,4 
C(L, I)-0.0 
64  CONTINUE 
DO  66  1-1,4 
DO  66  J-1,4 

PHIXd,  J)-0.0 
KZ(I,J)-0.0 
KXU(I, J)>0.0 
KXMd,  J)>0.0 


66  CONTINUE 
DO  70  1-1,4 
DO  70  J-1,4 
AH(I,J)-0 
BM(I,J)-0 
cm<i,J)-o 

QD(I, J)-0.0 
70  CONTINUE 

DO  903  1-1,4 
DO  903  J-1,3 
H(Jr I>-0.0 
K(IvJ>-0.0 
BD(I,J)-0.0 

903  CONTINUE 
JFLA8-0 

72  PRINT*, 'ENTER  DYNAMICS  MATRIX*  ' 

CALL  EDIT(A, 12, 12) 

IF ( JFLA6. NE. 0)  60  TO  140 
74  PRINT*, 'ENTER  CONTROL  MATRIX*  ' 

CALL  EDIT(B,3,3) 

IF(JFLAG.NE.O)  80  TO  140 
76  PRINT*, 'ENTER  OUTPUT  MATRIX*  ' 

CALL  EDIT (C, 4, 12) 

IF(JFLAG.NE.O)  60  TO  140 
78  PRINT*, 'ENTER  KX  MATRIX*  » 

CALL  EDIT(KX,4, 12) 

IFCJFLA6.NE.0)  80  TO  140 
80  PRINT*, 'ENTER  KZ  MATRIX*  ' 

CALL  EDIT(KZ,4,4) 

IFCJFLA6.NE.0)  60  TO  140 
82  PRINT*, 'ENTER  KXH  MATRIX*  » 

CALL  EDIT(KXM,4,4) 

IF ( JFLAG.NE.O)  80  TO  140 
84  PRINT*, 'ENTER  KXU  MATRIX*  » 

CALL  EDIT(KXU,4,4) 

IF (JFLAG.NE.O)  60  TO  140 
86  PRINT*, 'ENTER  MODEL  DYNAMICS  MATRIX:  ' 
JCFLA6-0 

CALL  EDIT(AM,4,4) 

IF (JFLAG.NE.O)  80  TO  140 
88  PRINT*, 'ENTER  MODEL  CONTROL  MATRIX*  ' 
JCFLA6-0 

CALL  EDIT(BM,4,4) 

IF (JFLAG.NE.O)  60  TO  140 
90  PRINT*, 'ENTER  MODEL  OUTPUT  MATRIX*  ' 

CALL  EDIT(CM,4,4) 

IF(JFLAG.NE.O)  80  TO  140 
IFUIFLA6.EQ.0)  60  TO  140 

904  PRINT*, 'ENTER  STATE  TRANSITION  MATRIX*' 
CALL  EDIT(PHIX,4,4) 

IF (JFLAG.NE.O)  80  TO  140 

905  PRINT*, 'ENTER  DISCRETE  TIME  INPUT  MATRIX' 
CALL  EDIT(BD,4,3) 


IF(JFLAB.NE.O)  80  TO  140 

906  PRINT*, 'ENTER  DISCRETE  TINE  COVARIANCE  NATRIXi ' 

CALL  EDIT(flD,4f 4) 

IF(JFLA6.NE.0>  80  TO  140 

907  PRINTS, 'ENTER  MEASUREMENT  MATRIX I ' 

CALL  EDIT(H,3,4) 

IF( JFLA8.NE.0)  80  TO  140 

908  PRINTS, 'ENTER  KALMAN  FILTER  BAINBi' 

CALL  EDITCK,4,3) 

IF(JFLAfl.NE.O)  80  TO  140 

J09  PRINTS, 'ENTER  MEASUREMENT  NOISE  COV.  MATRIX* 

CALL  EDIT(R,3r3) 

IF(JFLAQ.NE.O)  80  TO  140 
140  PRINTS, 'ANY  CHANGES  TO  MATRICES?  Y/Ni  » 

READ(S, ' (A) * )ANBW 

IF(ANBH.NE.'Y'.AND.ANSU.NE.'N')  80  TO  140 
142  IF(ANBW.EB«'Y')  THEN 

PRINTS,  »1-A  2-C  3-KX  44CZ  3-KXM  6-KXU' 

PRINTS, '7-AM  8-8M  9-CM  10-B  ' 

PRINTS, 'U^HIX  12-BD  13-QD  14-41  1S4  16-R» 

PRINTS, '  ENTER  CHOICE! ' 

READS, JFLA8 

80  TO  (72,76,78,80,82,84,86,88,90,74,904,900, 

1  906,907,908,909)  JFLA8 
ELSE 

JFLA8-0 
END  IF 

190  PRINTS, 'WRITE  DATA  TO  OUTPUT  FILE?  Y/Ni  ' 

READ(S, ’ (A)' )ANBW 

IF(ANBW.NE.'Y'.AND.ANBW.NE.'N')  80  TO  150 
IF(ANBW.EQ.'Y')  THEN 

PRINTS, 'ENTER  NAME  OF  OUTPUT  FILEi  ' 

READ(S, ' (A) ' )SAVE 

OPEN (3, FILE-SAVE, FORM-' UNFORMATTED' , ERR-80) 

WRITE(3) CCACI, J), 1-1, 12) , J-l, 12) 
NRITE(3)CCBCI,J),I-1,3),J-1,3) 

NRITE(3)((C(I,J), 1-1,4), J-l, 12) 

HRITE(3) ( (KX ( I , J) , 1-1 , 4) , J-l , 12) 

WRITE (3) < (KZ< I, J), 1-1,4), J-t, 4) 

WRITEC3)  «KXU<  I ,  J) ,  1-1 , 4) ,  J-l ,  4) 

WRITE (3)((KXM(I,J), 1-1,4), J-l, 4) 

WRITE(3)((AH(I, J), 1-1,4), J-1,4) 

WRITE (3) ( (BMC I, J), 1-1,4), J-l, 4) 

WRITEC3) ( (CMC I , J) , 1-1 , 4) , J-l , 4) 

IFCIIFLA8.EQ.0)  80  TO  910 

WRITEC3) ( (PHI X ( I, J), 1-1,4), J-l , 4) 

WRITEC3) ((BO(I, J), 1-1,4), J-1,3) 

WRITE(3)((QD(I,J), 1-1,4), J-1,4) 

WRITE(3) ( (H(I, J), 1-1,3), J-l, 4) 

WRITE(3)((K(I,J), 1-1,4), J-1,3) 

WRITE (3) ( (R( I , J) , 1-1 , 3) , J-l , 3) 

910  CONTINUE 

ENDFILEC3) 


ALL  INITIAL  CONDITIONS 


IF(JCFLAG.EQ.O)  THEN 

PRINT*, 'ENTER  SAMPLING  TINEi  » 

READ*rT8AMP 

CALL  DSCRT(AMt4,TSAMP,PHI,PHINT,30,AU0RK,BU0RK,CU0RK) 
CALL  HATML<PHINTy  BN, AUORK, 4, 4, 4) 

CALL  C0PYMTCAU0RK,PHINT,4,4> 

PRINT*, »  » 

JCFLA8-1 
END  IF 

PRINT*,  ’ENTER  CANARD  TRIM  ANGLE  OF  ATTACK’ 

READ*,EV(1) 

PRINT*, ’ENTER  8TABILAT0R  TRIM  ANGLE  OF  ATTACK  IN  RADIANS  * 
READ*,EV(2) 

EVTHP<1)^VU> 

EVTMP<2)-EV<2> 

PRINT*,’  RATE/POSITION  LIMITS?  Y/Nl  ’ 

READ(«, ' (A) ’ )ANBU 

IF (ANBU. NE. ’ Y’ . AND. AN8M. NE. ’ N’ )  80  TD  194 
IF(ANBU.EB.’Y')  HFLA^l 
1F(ANBU.EB.’N’>  MFLAG-0 
PRINT*,  *  ANTI-WINDUP  COMPENSATION?  Y/Ni  ’ 

READ(*, ’ (A) ’ )ANBM 

IF(ANSU.NE.’Y’.AND.ANSU.NE.’N’)  SO  TO  196 
IFCANBU.EQ. *Y’ >  NFLA8-1 
IF(ANBH.EO.’N’)  NFLA8-0 
PRINT*, ’EMPLOY  ACTUATOR  DYNAMICS?  Y/Nt  ’ 

READC*, ’ (A) ' )ANBH 

IF ( ANBU. NE. ’ Y’ . AND. ANSU. NE. *N’ )80  TO  222 
IFCANBU.EO.’Y’  >MM-0 
IF(ANBU.E0.’N’)H^1 

PRINT*, ’ENTER  DESIRED  RESPONSE  DURATION!  ’ 

READ*,D6IH 

IF(DSIH.LT.O.l)  80  TO  198 
I06IM-INT<D6IM/(90.0*TBAHP)*.99> 

DO  170  1-1,12 
XCD-0.0 
XOLD(I)-0.0 
CONTINUE 
EVA(l>-0.0 
EVA (2) -0.0 
DO  172  1-1,4 
UOLD(I>-0.0 


YCI >-0.0 
XNP(!>-0.0 
XHH<I>-0.0 
LMEU(I)-0.0 

172  CONTINUE 

DO  173  1-1,4 

ucmd(i>-o.o 

UC0LD(I>-0.0 

xmn-o.o 

XNOLD(I>-0.0 

Y(I)-0.0 

173  CONTINUE 

180  PRINT*, 'ENTER  I  AND  X(I>|  0,0  TO  TERMINATE!  » 

190  READ*, IIII, EL 

IFUIII.LE.  12.AND. IIII.8E.  1>  THEN 
X(IIII)-CL 
00  TO  190 

EL8E  IF(IIII.EO.O)  THEN 
00  TO  200 
ELSE 

PRINT*, 'SUBSCRIPT  OUT  OF  RANGE' 

00  TO  180 
END  IF 

200  PRINT*,*  SELECT  COMMAND  INPUT  it  STEP  MAGNITUDE! * 
READ*, IK, ELL 

IFUK.LE.3.AND.  IK.8E.  1)THEN 

UCHD<IK)-ELL 

ELSE 

PRINT*,’  8UBBCRIPT  OUT  OF  RANGE' 

80  TO  200 
END  IF 
T-0.0 
TOUT-O. 0 
IFLAB— 1 
RELERR-l.E-06 
AB8ERR-1.E-07 
U0(l)-0.0 
U0(2>-0.0 

IF(IIFLA8.E0.1)THEN 

PRINT*, 'ENTER  SOURCE  OF  OUTPUT  HEA8UREMENT8’ 
PRINT*, » 1 -SYSTEM  STATES  2-OUTPUT  VARIABLES' 

READ*,NN 
IF(NN.EQ. 1)THEN 

913  PRINT*, 'ENTER  STATES  TO  BE  MEASURED  (3)' 
READ*,L,H,N 

IF((L.6T. 12). OR. (L.LT.l))  60  TO  913 
IF((H.8T. 12). OR. (M.LT. 1) >  80  TO  913 
IF< (N.6T.  12). OR.  (H.LT.  1))  60  TO  913 
ELSE 

914  PRINT*, 'ENTER  OUTPUT  VARIABLES  TO  BE  MEASURED  (3) 
READS,  L,  H,N 

IF((L.8T.3).0R. (L.LT.l) >  80  TO  914 
IF((M.8T.3).0R. (M.LT. 1) )  80  TO  914 


IF((N.GT.3).0R. (N.LT. 1) )  00  TO  914 
END  IF 
END  IF 
XITER-1. 

IF(IIFLAG.EO.O)  00  TO  920 

PRINT*, 'ENTER  •  OF  ITERATIONS  FOR  FILTER  AVERAGE’ 

READ* | X ITER 

NR-3 

PRINT*, ’SELECT  SEED  VALUE  FOR  RANDQH  t  GENERATION 
READ*,D8EED 

PRINT*, ’CONTROL  BASED  ON  XHAT+  OR  XHAT-?’ 

PRINT*, » XHAT+-1  XHAT—2* 

READ*, JMFLAG 

IF((JMFLAfi.8T.2).QR. (JHFLAG.LT. 1))Q0  TO  937 

CONTINUE 

DO  750  11-1,51 

0UT(II,l>-0. 

0UTl(II,l>-0. 

U0UT2(II, l)-0. 

UOUT3(II,1)-0. 

0UT(II,2)-O. 

OUT (I I, 3) -0. 

0UT(II,4)-0. 

0UTl(II,2)-0. 

OUT1<II,3>-0. 

0UTl(II,4)-0. 

aUTl<II,5)-0. 

U0UT2(II,2)-0. 

U0UT2(II,3)-0. 

U0UT2(II,4)-O. 

U0UT3<II,2)-O. 

U0UT3(II,3)-O. 

U0UT3(II,4)-0. 

U0UT3(II,5)-0. 

CONTINUE 

IFCIIFLA6.ES.0)  GO  TO  1040 

DO  700  IJK-1, XITER 

T-0.0 

TOUT-O.O 

IFLA&—  1 

RELERR-1.E-00 

ABSERR-1 . E-07 

U0(l)-0.0 

UD(2>-0.0 

DO  1010  1-1,4 

XMD-0.0 

UOLDCD-O.O 

UNEU(I)-0.0 

UCHDCD-O. 

UC0LD(I)-0. 

XHOLDCD-O. 

Y<I)-0. 

XHP(I)-0. 


o  o 


XHh(I)-0. 

1010  CONTINUE 

DO  1020  1-1,12 
XTEHP(I)-0. 

X(I)-0. 

X0LD(I)-0. 

1020  CONTINUE 
X(IIII)-EL 
UCNDCIKl^LL 
EVACD-0.0 
EVA (2) -0.0 
EV(1)^VTNP<1) 

EV<2)^VTHP<2> 

1040  CONTINUE 

DO  300  I-ID6Ift+lySltID6IH+l 
CALL  ERX9ET (300,0) 

CALL  NATHL(Cy  X, Y,4, 12,1) 

IFUD8IH.NE.  l.AND.HODd,  ID8IH) 
J-INT(I/ID8IH> 

OUT(J, 1)-TOUT+OUT(J, 1) 
OUT(J,2)-Y(1)+OUT(J,2) 
OUT(J,3)-Y(2)-*OUT(Jy  3) 
0UT(J,4)-Y(3)+0UT(Jy4) 

C 

0UT1 < Jy 1 >«TUUT+0UT1 < Jy 1 > 
0UTl(J,2)HJNEU(l)+0UTl(Jy2) 
0UT1  <  Jy  3>-UNEW<2>+0UTl  <  Jy  3) 
0UT1  <  J,  4)HJNEW(3)+0UT1  C  Jy  4) 
0UT1 < Jy S)-UNEW(4)+0UT1 < Jy S> 

C 

U0UT2(J,  D-T0UT+U0UT2C  J,  1) 
U0UT2(Jy2)-X(3)+U0UT2(J,2) 
U0UT2CJ,  3)«X  <7)+U0UT2<  J,  3> 
U0UT2(J,4)-X(9)+U0UT2(J,4) 


U0UT3(  J,  l  )-T0UTHI0UT3<  J,  1 ) 
U0UT3<J,2)-X(1)+U0UT3(J,2) 
U0UT3C  J,  3)-X(2)-KJ0UT3(  J,  3) 
U0UT3(J,4)-X(3)+U0UT3(J,4) 
U0UT3C  J,  3)-X  (4) +U0UT3(Jy  3) 
ELSE  IFdOOIH.EQ.l)  THEN 
J-I-IDBIH 

OUT(Jyl)-TOUT+OUT<Jyl) 
0UT(J,2)-Y<1)+0UT(J,2) 
OUT(J,3)-Y(2)+OUT(J,3> 
0UT(Jy4)-Y(3)-KXJT(J,4> 

C 

OUTl(Jyl )-T0UT+0UTl ( J , 1 > 
0UT1(J,2)HJNEW(1)+0UT1<J,2> 
0UT1  ( J,  3MJNEU(2)  40UT1  (  J,  3> 
OUT1<J,4)KJNEH(3)+OUT1(J,4) 
OUTl(Jy3)-tlNEH(4)+OUTl(JyS) 


c 


U0UT2< J,  1  >«T0UTH»UT2(J,  1 ) 
U0UT2(J,2)-X(3)+U0UT2(J,2) 
U0UT2(J,3>-X(7)-HJ0UT2(J,3> 
U0UT2(J,4)-X(9)+U0UT2(J,4) 
C 

U0UT3<J, 1>-TOUT+UOUT3<J, 1) 
U0UT3(  J,2)-X<  1  >-MJ0UT3<  J,  2) 
UQUT3(Jr 3>-X C2) +UUUT3< Jr 3) 
U0UT3CJ, 4)«X(3)+U0UT3(Jr4) 
U0UT3(Jt3)»X<4)+U0UT3(J,3) 
END  IF 

TOUT-TOUT+TBANP 
IFdIFLAS.EO.  1)THEN 
CALL  08NhL(D6EED,NR,  V) 

v(i)H?a,i)*vci) 

VC2)-R(2,2)*V(2> 

VC3)H?(3,3)*V(3) 

IFCNN.EQ. 1)THEN 
Z(l)-X(L)+V(l) 

Z(2)-X(H)+V<2) 

Z(3)«X(N)+VC3) 

ELBE 

Zd)-Y(LHVd) 

Z(2)-Y(H)+V(2) 

Z<3)-Y<N)+V<3) 

END  IF 

CALL  KFILTCZ) 

IF(JNFLAS.EO.l)  THEN 
OO  913  J»l,4 
XTEHPCJ)-XHP(J) 

DO  913  KK-3,12 
XTEHP<KK>-0.0 
913  CONTINUE 
ELSE 

DO  980  J-1,4 
XTEMP(J)-XHh(J) 

DO  980  KK-3,12 
XTEHP 000-0.0 
980  CONTINUE 
EM)  IF 

CALL  8C8TAR(XTEHP,NFLA6) 

DO  230  J-1,12 

XOLD(J)-XTEHP(J) 

230  CONTINUE 

DO  260  J-1,4 

U0LD(J)4*EW(J) 

260  CONTINUE 

DO  262  J-1,4 

UCOLD(J)HJCMD(J) 

XMOLD(J)-XH(J) 

262  CONTINUE 

ELSE 
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,^j,vO‘rf'-V!rvi.VL*v\.Vu 


CALL  8C8TAR(X,NFLA0) 

DO  1060  JH-1,12 
XOLD(  JH)  -X ( JH > 

1060  CONTINUE 

DO  1070  JH-1,4 
XHOLD ( JH> -XH ( JH) 

UCOLD«JH)-UCHD<JH) 

UOLD(JH)HJNEU(JH> 

1070  CONTINUE 
EH)  IF 

CALL  ODE(FSTOL, 12, X , T, TOUT, RELERR, AB8ERR, IFLA6,U0RK, I WORK) 
T-TOUT 

IF(IFLA8.NE.2)  THEN 

PRINT*  <■  I FUSS  ■  ",  12)' , IFLA0 

FI  BC 

IFLA0— -2 
END  IF 
300  CONTINUE 
780  CONTINUE 

IF<IIFLA8.EQ.0>a0  TO  1310 
DO  738  1-1,31 
OUT(1, 1)-0UT(I,  D/XITER 
OUT( I ( 2) -OUT ( I f 2) /X ITER 
OUT < I , 3) -OUT < I , 3) /X ITER 
OUT(I,4)-OUT(II4)/XITER 
0UT1 C I f 1 ) -0UT1 < I f 1 ) /X ITER 
OUTt(I,2)H3UTl(I,2)/XITER 
OUT1(I,3)«OUT1(I,3)/XITER 
0UT1<I,4)*XJT1U,4)/XITER 
0UT1  (  I  f  3)-0UTlC  1 , 3) /X  ITER 
U0UT2CI,  1)-U0UT2(I,  D/XITER 
U0UT2< I , 2)-U0UT2( I , 2) /X ITER 
U0UT2C I f 3)-U0UT2(I t 3) /X ITER 
U0UT2< I , 4)-U0UT2< I , 4) /X ITER 
UCUT3U,  1)-U0UT3(I,  D/XITER 
U0UT3(I,2)-4J0UT3(If2)/XITER 
U0UT3(I,3)HJ0UT3(I,3)/XITER 
U0UT3( I , 4) -U0UT3< I , 4) /XITER 
U0UT3C 1 , 3)-U0UT3C I f 3) /X ITER 
733  CONTINUE 
1310  CONTINUE 

999  PRINT*,’  1 OUTPUT  VARIABLES  2-CONTROL  INPUTS  ’ 

PRINT*, ’  ^CONTROL  DEFLECTIONS  4-SYSTEH  STATES’ 

HHFLA8 

80  TO* (1000, 1100, 1200, 1300)  MHFLAG 

1000  CALL  8ETPLT(0UT,31,3,PLTVEC) 

PRINT*, 1  < - ENTER  TITLE  FOR  PLOT - ►» 

PRINT* 

READ(*,’(A)’)TITLE 

CALL  PLOTLP(PLTVEC, 31, 3,-1, 1,0, TITLE) 

80  TO  1400 

1100  CALL  8ETPLT(0UT1,31,3,PLTVEC) 

PRINT*,’  < - ENTER 


TITLE  FOR  PLOT 


t 


non  o  o  o  o 


PRINT* 

READtt,  *  (A)  ' ) TITLE 

CALL  PL0TLP(PLTVEC,51, 4,-1, 1,0, TITLE) 

60  TO  1400 

1200  CALL  9ETPLT (U0UT2, 91,5, PLTVEC ) 

PRINT*,'  - ENTER  TITLE  FOR  PLOT - ► 

PRINT* 

READ<*,»(A)»)TITLE 

CALL  PL0TLP(PLTVEC,91,3,-1, 1,0, TITLE) 

60  TO  1400 

1300  CALL  8ETPLT(U0UT3, 91, S, PLTVEC) 

PRINT*,'  -i - ENTER  TITLE  FOR  PLOT - ► 

PRINT* 

READ(*,'(A)*)TITLE 

CALL  PL0TLP<PLTVEC,31,4,-i, 1,0, TITLE) 

1400  PRINT*,'  MORE  OUTPUT  PLOTS?' 

READ(*,'(A)*)ANSN 

IF(ANSW.NE.'Y'.AW).ANSW.NE.’N')  60  TO  1900 
IF(ANBN.EQ.'Y')  60  TO  999 
1900  CONTINUE 

3214  PRINT*, '  INPUT  NAME  FOR  CALCOHP  PLOT  OF  OUTPUT' 

REAO(«, * (A) ' )PLOT 

OPEN (9, FILE-PLOT, STATUS-' NEW' , FORM-' FORMATTED' , ERR-3214) 
WRITEC9, FMT-' (4E20. 9) ' ) <  «JUT< J, I), 1-1,4), J-l ,91 ) 

ENDFILEC9) 

REUINDO) 

CL08EC9) 

3219  PRINT*, » INPUT  NAME  FOR  CALCOMP  PLOT  OF  CTRL.  DEF. ' 

READ(«, ' (A) ' )PLOT 

OPEN  (6,  FILE^LOT,  STATUS-'  NEW' ,  FORM-'  FORMATTED' ,  ERR-3219) 
WRITE(6,FNT-» (4E20.9)' )<<U0UT2CJ, I), 1-1,4), J-l, 91) 
ENDFILE(S) 

REWINDC6) 

CLOSE (6) 

929  PRINT*,  'CHANSE  MATRICES?  Y/Ni  ' 

READ(«, ' (A) * ) AM8W 

IF(ANBW.NE.'Y'.AND.ANBH.NE.'N')  80  TO  929 
IF(ANBW.EQ.'Y')  60  TO  142 

930  PRINT*, 'MORE  RUNS  WITH  NEW  MODEL?  Y/Ni  ' 

READ(*, * (A) ' )AN6W 

IF(ANBW.NE.'Y'.AND.ANSW.NE.'N')  60  TO  930 
IF(ANBW.EO.'Y')  60  TO  20 
END 

END  PROGRAM  0DEF19  - 


SUBROUTINE  FSTOLCT, X,DX) 


C**************************************************************^ 


c 
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oonc>  o  o  oooooooooo 


C  THI8  18  A  SET  OF  T  ORDER  ORDINARY  DIFFERENTIAL  EQUATI0N8  THAT 
C  DEFINE  THE  THE  DYNAMICS  OF  THE  BTOL  F-15  AIRCRAFT. 

ACTUATOR  DYNAMICS  ARE  INCLUDED  AS  ENTERED  IN  THE  12  X  12 
A  MATRIX  WHICH  HAS  BEEN  ENTERED  AT  THE  ONSET  OF  THE  PROGRAM 
IT  IS  A8SUMED  THAT  SECOND  ORDER  ACTUATORS  ARE  ASSOCIATED  WITH 
THE  STABILATOR  AM)  CANARD,  AND  FIRST  ORDER  WITH  THE  NOZZLE. 

NOTE  THAT  A  NON-LINEARITY  IS  INTRODUCED  INTO  THE  MODEL  BY  THE 
CONTROL  OF  BOTH  THRUST  AND  NOZZLE  DEFLECTION. 


REAL  T, X(12),DX(12),BNL(3,3> 

COMHON/MATRIX/UO(2), A(12, 12>,C<4, 12),KX<4, 12) ,KZ(4,4) , KXM<4,4) 
1 ,KXU<4, 4) , PHI (4, 4) , PHINTC4, 4) , CM(4, 4) , B(3, 3) , EV(2> , KFLA8, MM 

COMMON/CONTRL/UNEW (4) , UOLD (4) , UCHD C4) , UC0LD<4> 

1 , X0LD< 12) , XHOLD (4) , XM(4) , MFLA6, EVA(2) 


DO  444  1-1,3 
DO  444  J-1,3 
BNL(I,J)*0. 

444  CONTINUE 

SET  THE  SIGN  TO  ACCOUNT  FOR  CONTROL  SURFACES  PASSING 
THROUGH  A  ZERO  ANGLE  OF  ATTACK  RELATIVE  TO  THE  A/C 


EVA(1)-EV(1)+X(3) 

EVA(2)^V(2)+X<3) 

DO  5000  11-1,3 
BNLdI,3)-BdI,3) 

DO  5000  JJ-1 , 2 

BNL(II, JJ)*B(II, JJ) 

IF(EVA(JJ).GE.O)THEN 

IF((UO(JJ)+EVA(JJ) ).LT.O)  THEN 
BNL(1,  JJ)— B(l,  JJ) 

END  IF 
Fl  fif 

IFC (UO(JJ)+€VA<JJ)).6T.O)  THEN 
BNLd,  JJ)— B(l,  JJ) 

ENDIF 
END  IF 

5000  CONTINUE 

IF (MM. EG. 1)THEN 

DX(l)-A(l,l)*X(l)+A<l,2)*X(2)+A(l,3)*X(3)+Ad,4)*X<4) 
1+BNL(1,1)»UNEW(1)+BNL(1,2)«JNEW(2)+BNL<1,3)»UCW(3) 
DX(2)-A(2,1)*X<1)+A(2,2)*X(2)+A(2,3)*X(3)+AC2,4)*X<4) 
1+BNL(2, 1)*UNEW(1)+BNL(2,2)*UNEW(2) 
DX(3)-A(3,1)*X(1)+A(3,2)*X(2)+A(3,3)«X(3)+A(3,4)*X<4) 
l+BNL<3,l>*UNEWd)+BNL(3,2)*UNEW(2> 

DX(4)-X(2> 

DX(5)-0. 


o  o  o  o 


DX<6>-0. 

DXC7>-0. 

DX(8)-0. 

DX(9>-0. 

DX(10)-0. 

DXQD-O. 

DX<12)"0« 

U0(1)HJNEW(1) 

U0(2)HJNEU(2) 

X<5)-UNEWd> 

X(7)HJNEW(2) 

X(9)-UNEU(3> 

C 


DXd)«Ad,  l)*Xd)+Ad,2)*X(2)+Ad,3)*X(3)+Ad,4)*X(4) 
l+8NL(l,l>tX<3)+BNL<l,2>*X<7>+BNL(ly3)*X<9> 

DX<2>-A<2, 1  )*X  (1  )4A(2r  2)*X  (2>+A(2, 3)*X  (3>+A(2,  4>*X  (4) 
1+BNL(2,1)*X(3)+BNL(2,2)*X(7) 

DX<3>-A(3,l>tXd>+A<3,2)tX(2>+A<3,3>tXC3)+A<3,4)*X<4> 
1+BNL<3, 1 ) #X <3) +BNL (3, 2) *X (7) 

DXC4)-X(2) 

DX(5)>X<6) 

OX  <6>— 8336.  «X  <3>-303.  *X  (fi>  +8336.  «UNEU(  1 ) 

DX(7)-X<8> 

DX  (8)— 6336.  tX  (7)  -303.  *X  (8)48356.  tUNEH<2> 

DX  (9)  — 20.  *X  (9) 4-20.  tUNEU(3> 

DX(10)-0. 

DXUD-O. 

DXd2)«0. 

U0(1)«X<3) 

U0<2)-X(7) 

END  IF 

IF(NFLA6.EQ. 1 )  THEN 

I F< X (3) . 8E. . 262. AND. DX (3) . 8T. 0. 0) DX (3) -0. 0 
IF<X<3).LE.-.611.M».DXC3>.LT.O.O)DXC3>-0.0 
IF< X (6) . GE. . 401 . AND. DX (6) . 8T. 0. 0)DX <6>-0. 0 
IF(X(6).LE.-.40t.AND.DX(6).LT.O.O)DX(6)-0.0 
IF< X (7) . 6E. . 262. AND. DX <7> . QT. 0. 0) DX (7) -0. 0 
IF  (X  (7) .  LE.  **.  506.  AM).  DX  (7) .  LT.  0. 0)  DX  (7)  *0. 0 
IF(X(B).6E. . 803. AND. DX (8) . 8T. 0. 0) DX (8) -0. 0 
IF(X(8).LE.-.803. AND.DX(8) .LT.O.O)DX(8)aO.O 
END  IF 
RETURN 
END 


END  PUEPROGRAN  FSTOL 


SUBROUTINE  6C8TAR(Xf NFLA8) 


o  o  o 


SUBROUTINE  TO  CALCULATE  THE  C0NTR0L8  AT  EACH  SAMPLE  TIME. 
ANTI-WINDUP  COMPENSATED  IF  NFLA0-1. 


REAL  X(12),DEL(12),DEL2(12) 

INTEOER  NFLA6 

COMMON /MATRIX/U0(2) ,A( 12, 12) , C(4f 12) , KX (4, 12) , KZ  <4, 4) , KXM<4, 4) 
1  KXU(4,4) ,  PHI  (4, 4) ,PHINT<4,4)  f  CH<4, 4) ,  B<3, 3) ,  EV(2) ,  KFLA8,HH 
COMMON/CONTRL/UNEH (4) , UOLD C4) f UCMD(4) , UCOLD C4) , XOU)( 12) , 

1  XH0U)(4> , XM(4) ,MFLA6,EVA(2) 

CALL  NATHL(PHI ,  XMOLD,  XHt  4t  4, 1 ) 

CALL  MATML(PHINT,UCMD,DEL, 4,4,1) 

CALL  MATAD(XH,DEL,XM,4, 1) 

CALL  HATS8(X,X0LD, DEL, 12,1) 

CALL  HATHL(KX,DEL,DEL2,4, 12,1) 

CALL  MATSB (UOLD, DEL2,UNEW, 4,1) 

CALL  HATSB(XM, XMOLD, DEL, 4,1) 

CALL  MATHL(KXM, DEL, DEL2, 4,4,1) 

CALL  HATAD(UNEU,DEL2,UNEH,4, 1) 

CALL  MATSB (UCMD, UCOLD, DEL, 4,1) 

CALL  MATMLOCXU, DEL, DEL2, 4,4,1) 

CALL  HATAD(UNEU,0EL2,UNEW,4, 1) 

CALL  NATHL(CH,XH0LD,DEL,4,4,1) 

CALL  HATHL(C,X0LD,DEL2,4, 12, 1) 

CALL  MAT5B(DEL,DEL2,DEL,4, 1) 

CALL  HATHL(KZ,DEL, 0EL2, 4,4,1) 

CALL  MATADCUNEM,DEL2,UNEU,4,1) 

IFCNFLAQ.EQ. 1 )  THEN 

IF(UNEU(1).8T. .49-.87*XO))UNEH(l)-C.49-.B7tX(3))*l. 

IF (UNEH( 1 ) . LT. -1 . 14-. B7*X (5) ) UNEN ( 1 )- (-1 . 14-. B7*X (5) >*1 . 
IF«JNEW(2>.8T..49-.B7*X<7))UNEH(2)«.49-.B7*X(7) 
IF(UNEH<2).LT.-.96-.S7*X(7))UNEN<2)— .96-.B7*X<7) 

IF(UNEW( 1 ) . 8T. . 706+X (5) )UNEU ( 1 )-. 706+X (5) 
IF<UNEH(l).LT.-.706+X<S))UNEH(l)«-.706+X (5) 

IF(UNEU(2).6T. 1.522+X(7))UNEM(2)*1.522+X(7) 

IFtUNEH (2) . LT. -1 . 522+X (7) ) UNEW (2) — 1 . 322+X (7) 

END  IF 
RETURN 


SUBROUTINE  8C8TAR 


SUBROUTINE  RPOUT(A,M,N) 


C  THIS  ROUTINE  PRINTS  OUT  A  REAL  MATRIX  A 


O O O O O O O O O O O O O O O O O  OOOO  O Q o o o o O O O O Q o  oooo 


INTEGER  I,J,N,M 
DO  200  I-1,M 

PRINT'  C  \5(E11.4,3X))\  (A(I,  J>,  J-1,N) 
PRINT* 

200  CONTINUE 
END 

END  SUBROUTINE  RPOUT  - 


SUBROUTINE  SETPLT ( A, N,M,X> 

THIS  ROUTINE  CONVERTS  A  REAL  MATRIX  OF  DIMENSION  N  BY  M  INTO  A 
VECTOR  THAT  IS  COMPATIBLE  WITH  R.M.  FLOYD'S  PRINTER  PLOTTING 
ROUTINE,  PLOTLP.  THE  INPUT  MATRIX  18  A. 

N-  ROW  DIMENSION  OF  A,  THE  NUMBER  OF  POINTS  TO  BE  PLOTTED 
M-  COLUMN  DIMENSION  OF  A,  THE  NUMBER  OF  FUNCTIONS  TO  BE  PLOTTED  +1 
X-  THE  PLOTTING  VECTOR,  DIMENSION  NtM 


REAL  A(NrH)fX(N*M) 

INTEGER  NfH,I,J 
DO  100  J-ltM 
DO  100  1*1, N 

X(I+(J-1)*N)«A(I,J> 
100  CONTINUE 
END 

END  SUBROUTINE  SETPLT  - 


SUBROUTINE  PLOTLP (A, N, M, IPSC, IBCL,LPTERM, TITLE) 

THIS  ROUTINE  HAS  ADAPTED  FROM  R.M.  FLOYD'S  THESIS  TO  PRODUCE 
PRINTER  PLOTS  OF  COMPUTED  RESULTS. 

A-  VECTOR  OF  DATA,  CONVERTED  FROM  MATRIX  FORM  BY  SUBROUTINE  SETPLT 
N>  NUMBER  OF  POINTS  (INDEPENDENT  VARIABLE)  TO  BE  PLOTTED 
M-  NUMBER  OF  FUNCTIONS  (DEPENDENT  VARIABLES)  TO  BE  PLOTTED 
IPSC  -  -1— >ALL  VARIABLES  SCALED  TOGETHER  (1  PLOT) 

-  0 — >SCALED  TOGETHER  AND  SEPARATELY  (2  PLOTS) 

-  +1 — M3CALED  SEPARATELY  (1  PLOT) 

ISCL  *  0 — >PLOT  OVER  EXACT  RANGE  OF  VARIABLE 
♦1 — >PLOT  WITH  EVEN  SCALING 
LPTERH  -  0 — >PLOT  90  CHARACTERS  HIDE 
+1 — >PLOT  100  CHARACTERS  HIDE 
TITLE  *  MAX  OF  50  CHARACTERS,  TYPE  CHARACTER 


REAL  Y8CAL<6>,YHIN<6),YPRai>,RIBPAC,RmN,RHAX,YL,YH,XPR,A(*> 
REAL  9CAL 

INTEGER  IBLNKIS), IP8Cf ISCL,  LPTERM, I PAPER, ISP AC, IPRTIr ISC, J, IC, IX 
INTEGER  IL,JP,ITEHP,M1,K2,H,N,IC0,I 
CHARACTER  TITLEtSO 

CHARACTER* 1  BLANK, PLUS, COLON, GRID, SYMBOL (6) , OUT (101) 

DATA  BLANK, PLUS, COLON, SYMBOL <1>,8YMB0L (2) /»  V*V«V1V2»/ 
DATA  SYMB0L(3),SYHB0L(4>,SYHB0L(5),SYMB0L(G)/'3',U’,'S»/G»/ 
IPAPER-3*<l+LPTERM> 

ISPAO10*IPAPER 

RISPAOREALCISPAC) 

ISPAO ISPAC+ 1 

IPRTI-IPAPER+1 

RMN-ACN+1) 

RMAX-RMIN 
29  DO  41  1801,  M 
M1-ISC*N+1 
YL-A(Ml) 

YH-YL 

N2*4(*(I3C+1) 

DO  40  J=m,H2 

IF(A(J).LT.YL)THEN 

YL-A(J) 

END  IF 

IF(A(J).GT.YH)THEN 

YH-A(J) 

END  IF 

40  CONTINUE 
IF(YL.LT.RMIN)THEN 

RHIN-YL 
END  IF 

IF(YH.GT.RMAX)THEN 
RMAX-YH 
END  IF 

IF(IP9C.8E.0)THEN 

CALL  VAR8CL(YL,YH,Y8CAL(ISC),RI8PAC, ISCL) 

END  IF 
YHIN<I8C>-YL 

41  CONTINUE 
IF(IPSC.LE.O)  THEN 

CALL  VARSCL(RMIN,RHAX,8CAL,RI8PAC, ISCL) 

END  IF 

I02-IAB8(  IPSC) 

DO  42  IX-1,ISPAC 
OUT( IX) -BLANK 

42  CONTINUE 

DO  100, ICO-1, IC 

PRINT’ (" 1 ",  1 1 X, A50) ’, TITLE 
HRITEC4, ’ (11X,AS0)’ ) TITLE 
URITE(4,*(A1)’)BLANK 
PRINT* 

DO  SO  I-1,N 
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XPR-A!I) 

IF!HOD!I, 10).EQ.0)THEN 
0RID-COLON 
n  bp 

GRID-BLANK 
END  IF 

DO  44  IX-2,I8PAC,2 
OUT (IX) -GRID 
CONTINUE 

DO  46  IX-1, ISP  AC, 10 
OUT<IX)-4»LUS 
CONTINUE 
DO  SS  J-1,M 
IL«I+J*N 

IF(IPSC.EQ.-l) THEN 
JP=INT(  (A(  ID-RHIN)  /SCAL)+1 
ELSE  IFdP8C.EQ.0)THEN 
IPS.  PSC+ICO 
IF< IPSCT.EQ.2)THEN 

JP-INT! (AC IL)-YHIN!J))/Y8CAL!J) )+l 
Pi  ar 

JP-INT  ( (AC  ID-RHIN)  /BCAL)  +1 
END  IF 

FI  fig 

JP-INT! <A(IL)-YHIN( J) J/YBCALC J) )+l 
END  IF 

QUT(JP) -SYMBOL!  J) 

IBLNK(J)-JP 

CONTINUE 

PRINT* <"  ",F11.4,6X, 101A1)* , XPR, (OUT (I X) , I X-l , ISPAC) 
WRITE (4r  *  !FU.4,6X,  101A1)*  )XPR,  (OUT(IX) ,  IX-1,  ISPAC) 

DO  39  J-1,M 

ITEHP-IBLNK(J) 

OUT! ITEHP) -BLANK 
CONTINUE 
CONTINUE 

IF!IP9C.NE.  DTMEN 
IF!IP8CT.NE.2)THEN 
YPR!1)HWIN 
DO  70  1-1, I PAPER 

YPR!I+1)-YPR!I)+10.*SCAL 

CONTINUE 

PRINT*  dO  SCALE  ", 11E10.3)* , !YPR!I), 1-1, IPRTI) 
URITEC4  *!A1)*)BLAMK 

WRITEI4)* !"  SCALE  -,11E10.3)*)!YPR!I),I-1,IPRTI) 
URITE!4, * !A1 ) ’ ) BLANK 
WRITE!4, * !A1) ’ ) BLANK 
END  IF 
END  IF 

IF! IP8C.EQ. l.OR. IPSCT.EQ.2)THEN 
DO  76  1801,  M 

YPR!  D-YMIN!  ISC) 

DO  74  I -1,1 PAPER 


YPR(I+l>-YPR<I)+10.*Y8CAL(ISC) 

74  CONTINUE 

PRINT’ ("O  SCALE  "fAl,lX, 11E10.3)’, SYMBOL ( ISC) , (VPR(IX) 
1,IX-1,IPRTI> 

upTTpf  4  >  /  At  \  $  Aty 

URITE(4|’(a  SCALE  \Alf IX, I1E10.3)’ )8YHB0L(I8C), 
1(YPR(IX) , IX-1,  IPRTI) 

76  CONTINUE 

END  IF 

DO  90  ISC-1,36-N 

WRITE (4r ’ (Al)’ ) BLANK 
90  CONTINUE 
100  CONTINUE 

PRINT’ ("1")’ 


END  SUBROUTINE  PLOTLP 


SUBROUTINE  VARSCL(XHINt XHAX, SCALE. R8PACE, ISCL) 


C  THIS  IS  A  SCALING  ROUTINE  THAT  SUPPORTS  PLOTLP 
C  ADAPTED  FROM  R.H.  FLOYD’S  TIC8I8 

C 


REAL  XHIN, XHAX r SCALE, RSPACE,EXP, XHINT, XHAXT 
INTEGER  ISCL, I9CAL 
IF (  XHAX. EQ. XHIN) THEN 
XHH*.9*XMIN-10. 

END  IF 

3CALE-XHAX-XHIN 
IF ( ISCL. NE.O) THEN 

EXP-INT(  100.  HO810<SCALE)  )-100. 
FACTOR-10. **( 1 .  -EXP) 

XHINT-XHINtF ACTOR 


IF(  XHAXT.  8E.  0. )  THEN 
XHAXT-XHAXT+.  9 
END  IF 

IF < XHINT. LE.O. )THEN 
XHINT-XHINT-.9 
END  IF 

XNINT-AINT  CXHINT) 
ISCAL-XHAXT-XHINT 
IF (HOD ( ISCAL, S) . NE. 0) THEN 
ISCAL-I8CAL+3-H0D(ISCAL,3> 
END  IF 

FACT0R«10.tt<EXP-l.> 
XHIN-XMINT8F ACTOR 
8CALE<ACT0R*REAL  ( ISCAL) 


TO  EDIT  AM  h  BY  N  MATRIX  EDMAT 


3 


C  B-AN  H  BY  N  MATRIX 
C  OTHE  L  BY  N  PRODUCT  OF  A  AND  B 
C  MOTE i  ACTUAL  ARGUMENT  C  MUST  DIFFER 


REAL  A(L,M),B(H,N),C(L,N) 

INTEGER  I,J,KfL,M,N 
DO  100  I-irL 
DO  100  J*1 ,  N 
C(I,J)O.0 
100  CONTINUE 

DO  200  1*1 fL 
DO  200  J*lfN 
DO  200  K*1,M 

C(I,JX(I,  J)+A<I,IO*B<Kf  J) 

200  CONTINUE 
END 

END  SUBROUTINE  NATHL  - 


SUBROUTINE  MATADtA.B. C.L.M) 


C  THIS  ROUTINE  ADDS  TWO  REAL  MATRICES  OF  DIMENSION  L  BY  M 
C  A  AND  B  ARE  THE  INPUTS,  C  IS  THE  SUM 


REAL  A(L, H)rB(L,M),C(L,M) 
INTEGER  I, J,L,M 
DO  100  1*1 fL 
DO  100  J-1,M 

C(I,J)*A(I,J)+B<I,J) 
100  CONTINUE 
END 

END  SUBROUTINE  NATAD  - 


SUBROUTINE  HATSB(A,B,C,L,M) 


C  THIS  ROUTINE  SUBTRACTS  REAL  MATRIX  B  FROM  REAL  MATRIX  A 
C  DIFFERENCE  18  RETURNED  IN  REAL  MATRIX  C. 

C  ALL  THREE  MATRICES  ARE  OF  DIMENSION  L  BY  M 


REAL  A(L,M) , B(L,M) ,C(L, M) 


noo  oqooooqo  oooo  o o o o o o n o o o o  oooo 


INTEGER 
DO  100  1*1, L 
DO  100  J-1,M 

C(I, J)*A(I, J)-B(I, J) 
100  CONTINUE 
END 

END  SUBROUTINE  HATSB  - 


SUBROUTINE  SMUL(Ay ByCyLyM) 

THIS  ROUTINE  MULTIPLIES  A  REAL  MATRIX  BY  A  REAL  SCALAR 
A*  THE  SCALAR 
B-  THE  MATRIX 
C-  THE  PROOUCT 

B  AND  C  ARE  OF  DIMENSION  L  BY  M 

REAL  AyB(LyH)yC(LyH) 

INTEGER  Iy JyLyM 
DO  100  1-1  ,L 
DO  100  J-l.M 

C(I,J)=A*8CI,J) 

100  CONTINUE 
END 

END  SUBROUTINE  8HUL  - 


SUBROUTINE  COPYMTCA, BrNyH) 


THIS  ROUTINE  COPIES  A  REAL  MATRIX  A  INTO  REAL  MATRIX  B. 
BOTH  MATRICES  ARE  OF  DIMENSION  N  BY  M. 


REAL  A<N,H),B<N,M> 
INTEGER  I, JyNyM 
DO  100  I-lyN 
DO  100  J*1,M 
B(Iy J)*A(Iy J) 
100  CONTINUE 
END 


END  SUBROUTINE  COPYMT 


SUBROUTINE  D8CRT < A, Nf T8AMP, PHI , PHINT, M, TP, TI DENT, CUORK ) 


C  THIS  ROUTINE  APPROXIMATES  THE  STATE  TRANSITION  MATRIX  AND  ITS 
C  INTESRAL  FOR  A  TIME  INVARIANT  LINEAR  3Y8TEM  AS  A  MATRIX  EXPONENTIAL 
C  OVER  A  SHALL  SMPLE  PERIOD.  RESULTS  RETURNED  IN  REAL  MATRICES. 

C  A-  SYSTEM  DYNAMICS  MATRIX,  TYPE  REAL 
C  N*  STATE  DIMENSION 
C  TSAHP-  SAMPLING  PERIOD 
C  PHI*  STATE  TRANSITION  MATRIX,  TYPE  REAL 
C  PHINT-  APPROXIMATE  INTESRAL  OF  PHI,  TYPE  REAL 
C  M*  NUMBER  OF  TERMS  USED  IN  EXPONENTIAL  EXPANSION 
C  TP,  TIDENT  AND  CUORK  ARE  DUMMY  ARRAYS 


REAL  A(N,N),PHINT(N,N),PHI(N,N),TIDENT(N,N),TP(N,N) 
REAL  CUORK (N,N) 

REAL  TSAHP, RIJ 
INTESER  I, J,M,N 
DO  200  I*1,N 
DO  100  J*1,N 

TIDENTd,  J)*0.0 
CONTINUE 
TIDENTd,  I  )*1.0 
CONTINUE 

CALL  SHULCTBAMP, TIDENT, PHINT, N,N> 

CALL  COPYMT (PHINT, TP, N,N) 

CALL  SHULCTSAMP, A, PHI, N,N) 

DO  300  1*1,  H 

CALL  HATHL (TP, PHI, CUORK, N,N,N> 

CALL  COPYMT (CUORK, TP, N,N) 

R1J*1.0/REAL(I+1> 

CALL  SHULCRI J, TP, TP, N, N) 

CALL  MATAD(PHINT, TP, PHINT, N,N) 

CONTINUE 

CALL  HATHL (A, PHINT, TP, N,N,N> 

CALL  MATAD(TIOENT,TP,PHI,N,N) 


SUBROUTINE  KFILT(Z) 


C  SUBROUTINE  TO  INCORPORATE  THE  KALMAN  FILTER  INTO  THE  LOOP  FOR 
C  NON-LINEAR  PERFORMANCE  ANALYSIS. 


C0MHQN/C0NTRL/UNEU(4),U0LD(4),UCMD(4),UC0LD(4) , XOLDC 12) 


1  XNQLD(4) , XM<4) yMFLA6yEVA(2) , 

1  H(3r4)yPHIX(4y4)yBD(4t3)yQD(4y4)yR(3y3)yXHP(4)y XHH(4)yK(4y3) 
REAL  AU0RK(4y l)yBU0RK(4y l)yCM0RK(3y l)yIM]RK(3y l)yEW0RK(4y 1) 
REAL  Z(3> 

CALL  HATNL<PHIXyXHPyAM0RKy4y4yl> 

CALL  HATNL(BDyUNEHyBU0RKy4y3yl) 

CALL  MATAD(AU0RKyBU0RKyXHMy4yl) 

CALL  HATHL<HyXHMyCW0RKy3y4yi> 

CALL  HATS8(ZyCURKyDU0RKy3yl> 

CALL  HATNL(KyDW0RKyEU0RKy4y3y 1) 

CALL  HATADCXHM, EUORK,  XHPy  4,1) 

'  SUBROUTINE  KFILT - 


RETURN 
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a-4  Sample  Esaasai  Ei^vvuvu 

The  following  pages  contain  a  sample  run  of  ODEF15  on 


the 

CDC  Cyber 

V;-: 

C--' 

1  .  • 

w 

for 

0DEF15  and 

controller  as  given  in  Chapter  5.  The  output  of  the 
computer  is  in  upper  case  and  user  responses  are  in  lower 
case  text.  No  plots  are  shown  in  this  appendix,  but 
Figures  5-9  through  5-23  are  examples  of  the  available 
plots. 
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/. 


*»•  w*V 


vrtf 


/g  t , ode , odec , sch 1  us 
FILE  ODE  RETRIEVED 
FILE  ODEC  RETRIEVED 
PILE  SCHLUS  RETRIEVED 
/lasl 

IMSL5  ATTACHED 
/I Ibraryt lasl5,ode> 

LI BRAR Y ( I MSL5 , ODE  > 

/odec 

INCORPORATE  KALMAN  FILTER?  Y/N: 

?  y 

DATA  TO  BE  READ  FROM  FILE?  Y/N: 

?  y 

ENTER  NAME  OF  DATA  FILE: 

?  sch I  us 

ANY  CHANGES  TO  MATRICES?  Y/N: 

?  n 

WRITE  DATA  TO  OUTPUT  FILE?  Y/N: 

?  n 

ENTER  SAMPLING  TIME: 

?  .025 

ENTER  CANARD  TRIM  ANGLE  OF  ATTACK 
?  -.0857 

ENTER  STABILATOR  TRIM  ANGLE  OF  ATTACK  IN  RADIANS 
?  -.00457 

RATE/POSITION  LIMITS?  Y/N: 

?  y 

ANTI -WINDUP  COMPENSATION?  Y/N: 

?  y 

EMPLOY  ACTUATOR  DYNAMICS?  Y/N: 

?  y 

ENTER  DESIRED  RESPONSE  DURATION: 

?  10 

ENTER  I  AND  X<I>;  0,0  TO  TERMINATE: 

?  0  0 

SELECT  COMMAND  INPUT  &  STEP  MAGNITUDE: 

?  1 , - , 087 

ENTER  SOURCE  OF  OUTPUT  MEASUREMENTS 
1 =SYSTEM  STATES  2=0UTPUT  VARIABLES 
?  1 

ENTER  STATES  TO  BE  MEASURED  (3> 

?  1.2,4 

ENTER  t  OF  ITERATIONS  FOR  FILTER  AVERAGE 
?  5 

SELECT  SEED  VALUE  FOR  RANDOM  #  GENERATION 
?  354 

CONTROL  BASED  ON  XHAT+  OR  XHAT-? 

XHAT+=1  XHAT-*2 

?  1 

1 =OUTPUT  VARIABLES  2=C0NTR0L  INPUTS 
3=C0NTR0L  DEFLECTIONS  4=SY8TEM  STATES 
?  1 
♦ 


ENTER  TITLE  FOR  PLOT 
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01 

. 70E-0 1 

MORE  OUTPUT  PLOTS? 

?  n 

INPUT  NAME  FOR  CALCOMP  PLOT  OF  OUTPUT 
?  out 

INPUT  NAME  FOR  CALCOMP  PLOT  OF  CTRL.  DEF 
?  ctl 

CHANGE  MATRICES?  Y/N: 

?  n 

MORE  RUNS  WITH  NEW  MODEL?  Y/N: 

?  n 

133.955  CP  SECONDS  EXECUTION  TIME. 


APPENDIX  B.  STOLCAT 


B-i  latrsflustlgn 

STOLCAT  is  a  modification  of  the  Conversion  And 
Transformation  (CAT)  program  originally  written  by  Mr.  A. 
Finley  Barfield  131.  It  is  an  interactive  program  that  has 
been  modified  to  allow  for  the  increased  dimensionality 
associated  with  the  additional  control  surfaces  of  the  STOL 
F-15.  The  program  converts  the  raw  aerodynamic  data,  i.e. 
the  nondimens ional  coefficients,  weight  and  sizing 
parameters,  into  a  state-space  model  representation  for  the 
aircraft.  STOLCAT  can  be  used  for  longitudinal  axis  data, 
lateral  directional  data  separately,  or  both  sets  of  data 
simultaneously. 

STOLCAT  is  written  in  ANSI  FORTRAN  5  and  is  completely 
self-contained.  The  user  is  prompted  for  all  data  needed 
to  run  the  program,  including  the  units  and  reference 
frame  of  expected  inputs.  The  software  code  listing  and  a 
sample  program  execution  follow. 
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A  a  a  \ 


PROGRAM  STOLCAT 

REAL  ALPHA, Q, S, C, B, U, DTHETA, U, BIXX, BIYY, BIZZ, 

1BIXZ,0ALPHA,DPR,VT, 

2CZA, CZB, CZU, CZD1 , CZ02, CZD3, CZD4, CZD5, CZD6, CZD7, CZD8, 

3CXA, CXQ, CXU, CXD1 , CXD2, CXD3, CXD4, CXD5, CXD6, CX07, CXD8, 

4CMA, CMQ, CMU, CMOl , CMD2, CMD3, CMD4, CMD5, CMD6, CMD7, CMD8, 

5Z1, ZA, ZH, ZQ, ZU, ZD1, ZD2, ZD3, ZD4, ZDS, ZD6, ZD7, ZD6, 

6XA,  XH, XD, XU, XD1 , XD2, XD3, XD4, XD5, XD6, XD7, XD8, 

7M1 , MA, MH, MQ, MU, MD1 , MD2, MD3, MD4, MD5, MD6, MD7, MD6 
REAL  CNB,CYB,CLB,L,N 
DIMENSION  AMAT!4,4),BMAT<4,8) 

DIMENSION  DIRMAT (5,5) , DIRBMAT (5, 9) 

CHARACTERS  KEY,  KEY1,  DATA!,  DATA2,  DATA3,  RUN 
CHARACTER* 1  STAB1,STAB2 

DATA  Q  /48. 1/,S  /608./,  C  /15.94/,  B  /42.7/,  U  /201./ 

DATA  DTHETA  /11.8030/,  DALPHA  /ll.B030/,U  /3357G.14/ 

DATA  BIXX  /23644./,BIYY  /181947. /, BIZZ  /199674./.BIXZ  /-3086./ 
DATA  CZA  /-7.B4976E-2/,  CXA  / 1.50952766-3/,  CMA  /9.57411BE-3/ 

DATA  CZQ  /O./,  CXQ  /O./,  CMQ  /-. 16951603/ 

DATA  CZU  /-l. 06551597/,  CXU  /-6. 1932E-3/,  CMU  /6. 394289E-2/ 

DATA  CZH  /-l. 676463E-4/,  CXH  /6. 662777E-4/ ,  CMH  /1.76622E-4/ 

DATA  CZD1  /-2.63634E-3/,  CXD1  /-1.552420E-3/,  CMD1  /5.57696E-3/ 
DATA  CZD2  /-8.31511E-3/,  CXD2  /-2.749671E-4/,  CMD2  /-1.02066E-2/ 
DATA  CZD3  /-5.59102E-3/,  CXD3  /l. 157373E-3/,  CMD3  /8.52107E-4/ 
DATA  CZD4  /-4. 508436-3/,  CXD4  /9.4211093E-4/,  CMD4  /-2. 111186-3/ 
DATA  CZDS  /1.896349E-3/,  CXD5  / -3. 1209096-3/ ,  CMOS  /2.55459E-3/ 
DATA  CZD6  /-7. 422954E-4/,  CXD6  /-3. 5956366-3/,  CMD6  /-1.30123E-3/ 
DATA  CZD7  /1.896349E-3/,  CXD7  /-3. 1209B9E-3/,  CMD7  /2.55459E-3/ 
DATA  CZD8  /-7.422954E-4/,  CXD8  /-3.59565BE-3/,  CMOS  /-1.30123E-3/ 
DATA  CLB  /-2.973933E-3/,  CNB  /-5.5065055E-4/,  CYB  /-1.637941E-2/ 
DATA  CLP  /-5.740524E-3/,  CNP  / -2. 30997196-3/,  CYP  /  0.000000000/ 
DATA  CLR  /  3.902348E-3/,  CNR  /-9.6998151E-3/,  CYR  /  0.000000000/ 
DATA  CLD1/1.0017E-4/,  CND1/-1.3256E-3/,  CYD1/3.0606E-3/ 

DATA  CLD2/-1. 14999E-4/,  CND2/5. 1323E-4/,  CYD2/ 1.3 1396-3/ 

DATA  CLD3/8. 31046-4/ ,  CND3/4. 4837E-4/,  CYD3/-1 . 0622E-3/ 

DATA  CLD4/7. 52846-4/ ,  CND4/7. 61386-5/,  CYD4/- 1.52356-4/ 

DATA  CLD3/6. 99596-4/,  CNDS/O.OO/,  CYD5/0.00/ 

DATA  CLD6/9. 68166-5/,  CND6/ 1.59346-4/,  CYD6/0.0/ 

DATA  CLD7/-3. 7897E-3/ ,  CND7/1 . 8357E-4/,  CYD7/0.0/ 

DATA  CLD8/-9. 68166-5/,  CND8/- 1.59346-4/,  CYD8/0.0/ 

DATA  CLD9/3. 7897E-5/ ,  CND9/-1. 8337E-4/,  CYD9/0.0/ 

DPR  »  57.2957795 
uriteu,5>  format  ax,  » 

WRITE!*, 10) 

10  FORMATdX,  ’***  STABILITY  DERIVATIVE  TRANSFORMATION  PROGRAM  ***') 
WRITE!*, 20) 

20  FORMATdX, ’ tttttttttttttttttttttttttttttttttttttttttttttttttttt’ ) 
WRITE!*, 100) 

100  FORMAT (IX, ’ENTER  BODY  AXI8  (NON-DIMENBIONALIZED)  COEFFICIENTS  ’) 
WRITE!*, 101) 

?-jr-  101  FORMAT!lX,  ’FOR  TRANSFORMATION  TO  DIMENSIONAL  I  ZED  BODY  AXIS’) 

WRITE!*, 102) 

102  FORMAT! IX, ’AND  TO  GENERATE  STATE  AND  INPUT  MATRICES.’) 
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WRITE (*,41) 

41  FORMAT (IX, ’NOTE i  ALL  COEFFICIENTS  ARE  REQUESTED  WHEN  COMPUTING’ ) 

103  CONTINUE 
WRITEC*, 30) 

30  FORMAT(lXy  ’  t***t*t*t*UtU**tt**t*UUtU*ttU**Utt**t*ttt**t*f  ) 
WRITEC*, 106) 

106  FORMAT (IX, ’TO  TRANSFORM  ONLY  LONGITUDINAL  DATA  -  TYPE  LONG’) 
WRITEC*, 107) 

107  FORMAT ( 1 X , » TO  TRANSFORM  ONLY  LATERAL-DIRECTIONAL  DATA  -  TYPE  LAT’ ) 
WRITEC*,  108) 

100  FORMAT (IX, ’TO  TRANSFORM  BOTH  LONG  AND  LAT-DIR  DATA  -  TYPE  BOTH*) 
WRITEC*,  111) 

111  FORMAT ( IX, ’KEYWORD  *  ’) 

READC*,  109)  KEY 

109  FORMAT (A3) 

IF(KEY  .EQ.  ’LAT’)  GO  TO  104 
IF (KEY  .EQ.  ’LON*)  GO  TO  104 
IFCKEY  .EQ.  ’BOT’)  GO  TO  104 
IF (KEY  .EQ.  ’GAM’)  GO  TO  396 
GO  TO  103 

104  CONTINUE 
WRITEC*, 300) 

500  FORMAT < IX, » t**************************************************** ) 
WRITEC*, 310) 

310  FORMAT (1X,’Q  C DYNAMIC  PRESSURE  -  LBS/FT**2>  =  ’) 

READC*,*)  Q 
WRITEC*  320) 

520  FORMAT (1X,’S  CWIN6  REFERENCE  AREA  -  FT**2)  ■  ’ ) 

READC*,*)  S 
WRITE (*,530) 

530  FORMAT C IX, ’C  CWING  MEAN  AERODYNAMIC  CORD  -  FT)  -  ’ ) 

READC*,*)  C 
WRITEC*, 540) 

540  FORMAT C IX, ’B  CWING  SPAN  -  FT)  *  ’) 

READC*,*)  B 
WRITEC*, 530) 

550  FORMAT C 1 X , ’ VT  CTRIM  VELOCITY  -  FT/SEC)  =  ’) 

READ  C*,*)  U 
VT*U 

WRITEC*, 360) 

360  FORMAT C IX, ’THETA  (PITCH  ANGLE  -  DEGS)  =  ’) 

READC*,*)  DTHETA 
WRITEC*, 370) 

570  F0RMATC1X, *W  C WEIGHT  -  LBS)  =  ’) 

READC*,*)  W 
WRITEC*, 575) 

373  F0RMATC1X,’ INERTIAS  MUST  BE  INPUT  IN  BODY  AXIS.’) 

WRITE (*,500) 

500  F0RMATC1X, ’ IXX  CSLUG-FT**2)  *  ’) 

READC*,*)  BIXX 
WRITEC*, 585) 

585  F0RMATC1X, * IYY  CSLU8-FT**2)  *  ’) 

READC*,*)  BIYY 
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PROGRAM  STOLCAT 

REAL  ALPHA,Q, S,C,B,U,DTHETA,U,BIXX,BIYY,BIZZ, 

1BTX7,DAI  PllAlnrff<VTl 

2CZA,CZQ, CZu| CZD1 y  CZD2y  CZD3y  CZD4, CZDSy  CZD6, CZD7, CZD8y 
3CXA  y  CXQy CXUy  CXD1 , CX02y  CXD3y  CXD4, CXD5y CXD6, CXD7, CXD0y 
4Cmy  CMQy  CMU,  CMD1 ,  CMD2,  CMD3y  CMD4,  CMD5,  CMD6,  CMD7,  CMD8y 
5Z 1 y  ZAy  ZHy  ZQ, ZU, ZD1 y  ZD2, ZD3, ZD4, ZDS, ZD6, Z07, ZDB, 

BXA, XH, XOy  XU, XD1, XD2, XD3, XD4, XD5, XD6, XD7, XD8, 

7M1 , MA, MH, HQ, MU, MD1 , MD2, MD3, MD4, ND3, MD6, MD7, MDG 
REAL  CNB,CYB,CLB,L,N 
DIMENSION  AMAT(4,4),BMAT(4, 8) 

DIMENSION  DIRMAT (5,5), DIRBMAT (5,9) 

CHARACTERS  KEY,  KEY1,  DATA1,  DATA2,  DATA3,  RUN 
CHARACTERS  STAB1,STAB2 

DATA  Q  /48.1/,S  /609./,  C  /15.94/,  B  /42.7/,  U  /20i./ 

DATA  DTHETA  /11.8030/,  DALPHA  /ll.B030/,W  / 33576. 14/ 

DATA  BIXX  / 23644. /,BIYY  /181847. /, BIZZ  / 199674. /, BIXZ  /-3086./ 
DATA  CZA  /-7. 04976E-2/,  CXA  /1.5095276E-3/,  CHA  /9.574110E-3/ 

DATA  CZQ  /O./,  CXQ  /O./,  CMS  /-. 16951603/ 

DATA  CZU  /- 1.06551 597/,  CXU  /-6. 1932E-3/,  CMU  /6. 3942B9E-2/ 

DATA  CZH  /-1.676463E-4/,  CXH  /&. 662777E-4/ ,  CMH  /1.76622E-4/ 

DATA  CZD1  /-2.63634E-3/,  CXDi  /-1.552420E-3/,  CHD1  /5.57696E-3/ 
DATA  CZD2  /-8.3151 IE-3/,  CXD2  /-2.749671E-4/,  CMD2  /-1.02066E-2/ 
DATA  CZD3  /-5.59102E-3/,  CXD3  /l. 157373E-3/,  CMD3  /B.52107E-4/ 
DATA  CZD4  / -4. 500436-3/ ,  CXD4  /9. 421 10936-4/,  CMD4  /-2. 1 1 1 196-3/ 
DATA  CZD5  / 1.8963496-3/,  CXD5  / -3. 1209096-3/,  CMD5  /2. 554596-3/ 
DATA  CZD6  /-7. 422954E-4/,  CXD6  / -3. 5956566-3/,  CMD6  /-l. 301236-3/ 
DATA  CZD7  /l. 0963496-3/,  CXD7  /-3. 1209996-3/ ,  CMD7  /2.55459E-3/ 
DATA  CZDG  /-7. 4229546-4/,  CXD8  / -3. 5956506-3/,  CMD0  /-I .301236-3/ 
DATA  CLB  / -2. 9739336-3/,  CNB  /-5. 50650556-4/,  CYB  /-l. 637941 E-2/ 
DATA  CLP  /-5. 7405246-3/,  CNP  /-2. 30997196-3/,  CYP  /  0.000000000/ 
DATA  CLR  /  3.9023496-3/,  CNR  /-9.699B151E-3/,  CYR  /  0.000000000/ 
DATA  CLD1/1. 0017E-4/,  CND1/-1. 3256E-3/,  CYD1/3. 06066-3/ 

DATA  CLD2/-1. 149996-4/,  CND2/5. 1323E-4/,  CYD2/1. 31396-3/ 

DATA  CLD3/B. 5 1046-4/,  CND3/4. 4837E-4/,  CYD3/-1 .06226-3/ 

DATA  CLD4/7. 52946-4/,  CND4/7. 61396-5/,  CYD4/-1. 52356-4/ 

DATA  CLD5/6. 99596-4/,  CND5/0.00/,  CYD5/0.00/ 

DATA  CLD6/9. 69166-5/,  CND6/1. 59346-4/,  CYD6/0.0/ 

DATA  CLD7/-3. 79976-5/,  CND7/1.8357E-4/,  CYD7/0.0/ 

DATA  CLD0/-9. 69166-5/,  CND0/- 1.59346-4/,  CYDB/O.O/ 

DATA  CLD9/3. 7997E-5/ ,  CND9/-1 .B357E-4/,  CYD9/0.0/ 

DPR  »  57.2957795 

WRITE(*,5)  FORMAT (1 X , ’ *t* I * ttttttttttttttttttttttttt tttttttttt*** 
WRITE(t, 10) 

10  FORMAT ( IX, ’ ttt  STABILITY  DERIVATIVE  TRANSFORMATION  PROGRAM  ***’) 

WRITE (*,20) 

20  FORMATdX, *<<<<*<<*******1 ><<*<*<<*<*<********<* *<*<****<*<<***’  ) 

WRITEC*, 100) 

100  FORMAT (IX, ’ENTER  BODY  AXIS  (NON-DIMENSIONAL I ZED)  COEFFICIENTS  ’) 
MRITE(t, 101) 

101  FORMATdX,  ’FOR  TRANSFORMATION  TO  DIMENSIONAL  I  ZED  BODY  AXIS’) 
MRlTE(t, 102) 

102  FORMATdX, ’AND  TO  GENERATE  STATE  AND  INPUT  MATRICES.’) 


(SLUG-FT**2> 


•  sei3.fi) 
S613.fi) 


S613.fi) 


WRITE(*,590) 

FORHATdX, 'IZZ  (SLU6-FT**2)  =  ») 

READ!*,*)  BIZZ 
WRITE (*,595) 

FORHATdX, ’ IXZ  (SLU6-FT**2)  -  ') 

READ(*,*)  BIXZ 
CONTINUE 
WRITE (*,597) 

FORHAT(ix,'m*n»mmm»**m<»»m*«m««*****»* 

WRITE(*,filO) 

FORMAT (16X, 'AIRCRAFT  PARAMETERS') 

WRITE(*,fil5)  Q 

FQRMATdX,  'Q  (DYNAMIC  PRESSURE  -  LBS/FT**2)  -  ',613. 
WRITE (*,620)  S 

FORHATdX,  'S  (WINS  REFERENCE  AREA  -  FT**2)  -  ',613.6 
WRITE (*,625)  C 

FORHATdX, 'C  (WIN6  MEAN  AERODYNAMIC  CORD  -  FT)  ■  '  ,6 
WRITE (*,630)  B 

FORHATdX, 'B  (UIN6  SPAN  -  FT)  -  ',613.6) 

WRITE (*,635)  U 

FORHATdX, 'VT  (TRIM  VELOCITY  -  FT /SEC)  »  ',613. 6) 
WRITE (*,640)  DTHETA 
FORHATdX, 'THETA  -  ',613.6) 

UDTTCV*  C4S)  U 

FORMAT (IX, 'W  (WEIGHT  -  LBS)  ■  ',613.6) 

WRITE(*,630)  BIXX 

FORHATdX,  »IXX  (SLU6-FT**2)  =  ',613.6) 

WRITE (*,655)  BIYY 

FORHATdX,  »IYY  (SLU6-FT**2)  =  ',G13.6) 

WRITE(*,660)  BIZZ 

FORHATdX,  »IZZ  (SLUG~FT**2)  =  ',613.6) 

WRITE (*,665)  BIXZ 

FORHATdX, 'IXZ  (SLU6-FT**2>  =  ',613.6) 

WRITE(*,670) 

FORHATdX, » «*<******»<mm**********mmm*»<** 

CONTINUE 

WRITE (*,675) 

FORHATdX, 'IS  THE  ENTERED  DATA  CORRECT  ?  (YES/NO)  ') 
READ (*,680)  DATA3 
FORMAT (A3) 

WRITE (*,685) 

FORHATdX,  'ywmMmmm*****  ******************* 

IF (DAT A3  .EQ.  'NO  ')  60  TO  104 

IF (DATA3  .EQ.  'YES')  60  TO  686 

60  TO  600 

CONTINUE 

WRITE!*, 105) 

FORHATdX, 'ALPHA  (DE6)  -  ') 

READ!*,*)  DALPHA 

THETA  ■  DTHETA/DPR 

ALPHA  -  DALPHA/DPR 

IF (KEY  .EQ.  'LAT' )G0  TO  446 

IF (KEY  .EQ.  '6AM' )60  TO  97 


',613.6) 


',613.6) 


',613.6) 


WRITE!*, 110) 

FORMAT  !1X,»CZA  -  ») 
READ!*,*)  CZA 
WRITE!*, 120) 

FORMAT !1X,»CX A  *  ') 
READ!*,*)  CXA 
WRITE!*, 130) 

FORMAT! IX, »CMA  -  ») 
READ!*,*)  CMA 
WRITE!*, 140) 

FORMAT! IX, ’ CZQ  *  ') 
READ!*,*)  CZQ 
WRITE!*, ISO) 

FORMAT !1X,»CXQ  -  ’) 
READ!*,*)  CXQ 
WRITE!*, 160) 

FORMAT ! 1 X ,’ CMQ  -  *> 
READ!*,*)  CMQ 
WRITE!*, 170) 

FORMAT !1X,»CZU  =  ») 
READ!*,*)  CZU 
WRITE!*, 180) 

FORMAT !1X,'CXU  =  *) 
READ!*,*)  CXU 
WRITE!*, 190) 

FORMAT !1X,’CMU  =  *) 
READ!*,*)  CHU 
WRITE!*, 191) 

FORMAT! IX, ’CZH  -  ») 
READ!*,*)  CZH 
WRITE!*, 192) 

FORMAT !1X,»CXH  «  » ) 
READ!*,*)  CXH 
WRITE!*, 193) 

FORMAT! IX, »CMH  «  ») 
READ!*,*)  CHH 
WRITE!*, 200) 

FORMAT !1X,'CZD1  *  ») 
READ!*,*)  CZD1 
WRITE!*, 202) 

FORMAT !1X,'CXD1  *  ») 
READ!*,*)  CXD1 
WRITE!*, 204) 

FORMAT! IX, »CMD1  »  *) 
READ!*,*)  CMD1 
WRITE!*, 206) 

FORMAT !1X,»CZD2  «  ') 
READ!*,*)  CZD2 
WRITE!*, 208) 

FORMAT !1X,»CXD2  -  ') 
READ!*,*)  CXD2 
WRITE!*, 210) 

FORMAT !1X,»CMD2  «  ») 


--y-. ‘A v’s.^s.v.' -  '.a.’--' 


S«S 


it 


as? 


REAOC*,*)  CMD2 
WRITEC*, 212) 

212  FORMAT C1X,»CZD3  = 
REAOC*,*)  CZD3 
WRITEC*, 214) 

214  F0RMATC1X,»CXD3  « 
REAOC*,*)  CXD3 
WRITEC*, 216) 

216  F0RMATC1X, ’CMD3  - 
REAOC*,*)  CHD3 
WRITEC*, 218) 

218  FORMAT C1X,’CZD4  = 
REAOC*,*)  CZD4 
WRITEC*, 45) 

45  FORMAT C1X,»CXD4  « 

REAOC*,*)  CXD4 
WRITE (*,50) 

50  FORMAT (1X,’CMD4  - 

REAOC*,*)  CMD4 
WRITE (*,55) 

55  FORMAT <1X,»CZD5  - 
REAOC*,*)  CZD5 
WRITE (*,60) 

60  FORMAT (1X,'CXD5  - 
REAOC*,*)  CXOS 
WRITE (*,65) 

65  FORMAT C1X,»CMD5  » 
REAOC*,*)  CMOS 
WRITE<*,70) 

70  FORMAT C1X,»CZDE  ■ 
REAOC*,*)  CZD6 
WRITE (*,75) 

75  FORMAT C1X,'CXD6  - 
REAOC*,*)  CXD6 
WRITE (*,80) 

80  FORMAT C 1 X, fCMD6  - 

REAOC*,*)  CM06 
WRITE (*,85) 

85  FORMAT C IX, fCZ07f ) 
REAOC*,*)  CZD7 
WRITEC«,88) 

88  F0RMATC1X, '0X07' ) 
REAOC*,*)  CXD7 
WRITEC*, 90) 

90  FORMAT C IX, ’CMD7  -  * 
REAOC*,*)  CMD7 
WRITEC*, 92) 

92  FORMAT C1X,»CZD8  «  * 
REAOC*,*)  CZ08 
WRITEC*, 94) 

94  FORMAT C1X,»CXD8  ■  • 
REAOC*,*)  CXD8 
WRITEC*, 96) 


96  FGRMTUX, ’CHDe  -  ’) 

READ(*,*>  CMD8 

97  CONTINUE 
WRITE(*,225) 

225  FORMAT(ix,»*«**»m*m»*m*««««**»*mm«*******mm***<»*') 
WRITE (*,230)  DALPHA 
230  FORMAT (15X, 'ALPHA  *' ,613.6) 

WRITE (*,345) 

345  F0RMAT(6X, ’LONGITUDINAL  NON-DIM  BODY  AXIS  COEFFICIENT  1/DE6>» ) 

CAL  =  COS(ALPHA) 

SAL  *  SIN(ALPHA) 

COSSQ  -  CAL**2 
SI  NSC  «  SAL**2 
COSSIN  =  CAL*SAL 
CTH  -  COS (THETA) 

STH  =  SIN(THETA) 

* 

WRITE (*,360)  CZA,CHA,CXA 

360  FORMAT (3X,'CZA  *  ’ , 613.6, 8X, ’CMA  «  ' ,813.6,5X, ’CXA  *  ’,T.3.£, 
WRITE (*,390)  CZQ,CHB,CXQ 

390  FORMAT (3X,'CZQ  *  ’ ,813.6, 8X,  'CMQ  =  ’ ,613.6,5X,  'CXQ  =  >,bL.6) 
WRITE (*,400)  CZH,CMH,CXH 

400  FORMAT (3X, * CZH  -  ' ,813.6, 8X, »CMH  «  ’ ,813.6, 5X, 'CXH  -  ',813.6) 
WRITE(*,410)  CZU,CHU,CXU 

410  FORMAT (3X,’CZU  *  ' ,613.6, 8X, »CMU  =  ' ,613.6,5X, 'CXU  *  ',613. 6) 
WRITE(*,370)  CZD1,CMD1,CXD1 

370  FORMAT (2X,'CZD1  =  » ,613.6, 7X, 'CMD1  *  ' ,613.6, 4X, »CXD1  *  ',613.6) 
WRITE (*,380)  CZD2, CMD2, CXD2 

380  FORMAT (2X,'CZD2  *  ' ,613.6, 7X, 'CMD2  =  ' ,613.6, 4X, *CXD2  =  ',613.6) 
WRITE(*,381)  CZD3, CMD3, CXD3 

381  FORMAT (2X, 'CZD3  -  ' ,613.6, 7X, 'CMD3  -  ' ,613.6, 4X, 'CXD3  =  ',613.6) 
WRITE (*,382)  CZD4, CMD4, CXD4 

382  FORMAT (2X,'CZD4  -  ' ,613.6, 7X, 'CMD4  *  ' ,613.6, 4X, 'CXD4  *  ',613.6) 
WRITE (*,383)  CZD5, CMD5, CXD5 

383  FORMAT (2X,»CZD5  »  ' ,613.6, 7X, 'CMD5  =  ' ,613.6, 4X, 'CXD5  *  ',613.6) 
WRITE (*,384)  CZD6, CMD6, CXD6 

384  FORMAT (2X, 'CZD6  *  ' ,613.6, 7X, 'CMD6  »  ' ,613.6, 4X, 'CXD6  *  ',613.6) 
WRITE(«,385)  CZD7, CMD7, CXD7 

385  FORMAT (2X, 'CZD7  *  ' ,613.6, 7X, 'CMD7  *  ' ,613.6, 4X, »CXD7  *  ',613.6) 
WRITE(*, 386)  CZD8, CMD8, CXD8 

386  FORMAT (2X,»CZD8  *  » ,613.6, 7X, 'CMD8  «  ' ,613.6, 4X, 'CXD8  «  *,613.6) 
WRITE(»,310) 

315  CONTINUE  * 

WRITE  (*,320) 

320  FORMATdX,  'IS  THE  ENTERED  DATA  CORRECT  ?  (YES/NO)') 

READ (*,330)  DATA1 
330  FORMAT (A3) 

IF(DATA1  .EQ.  'NO  ')  GO  TO  686 
IF(DATA1  .EQ.  ’YES')  60  TO  340 
60  TO  315 
340  CONTINUE 


A  ^ 


WRITE  0,420) 

420  forhatux, 


Zl  -  <Q*S*32.2)/W 
A  -  C/(2.0*U) 

THETA  -  DTHETA/DPR 


C 


C 


C 

C 


C 


700 

705 

710 


ZA  =  Z1*CZA*DPR 
ZH  -  (Zl/UXCZH 
ZQ  -  Z1<A<CZQ<DPR 
ZU  »  2.<(Z1/U)<CZU 
ZD1  =  ZKCZDKDPR 
Z02  -  Z1<CZD2<DPR 
ZD3  -  Z1<CZD3<0PR 
ZD4  -  Z1<CZD4<DPR 
ZDS  *  Z1<CZD5<DPR 
ZD6  -  Z1<CZD6<DPR 
ZD7  *  Z1<CZD7<DPR 
ZD8  -  ZKCZDStDPR 


XA  »  Z1<CXA<DPR 
XH  -  (Zl/UXCXH 
XQ  «  Z1<A<CX0<DPR 
XU  »  2.<(Z1/U)<CXU 
XD1  =  ZKCXDKDPR 
XD2  -  Z1<CXD2<DPR 
XD3  »  Z1<CXD3<DPR 
XD4  -  Z1<CXD4<DPR 
XD5  -  Z1<CXD5<DPR 
XD6  -  Z1<CXD6<DPR 
XD7  ■  Z1<CXD7<DPR 
XD8  -  Z1<CXD6<0PR 


Ml  «  (0<S<C)/BIYY 


HA  >  M1<CMA<DPR 
MH  -  (Nl/UXCHH 
HQ  -  H1<A<CHQ<0PR 
HU  -  2.<(M1/U)<CHU 
MD1  «  HKCMDKDPR 
HD2  -  M1<CHD2<DPR 
MD3  -  H1<CHD3<DPR 
HD4  ■  H1<CHD4<DPR 
HDS  -  H1<CHD5<0PR 
MD6  -  M1<CHD6<DPR 
HD7  -  H1<CHD7<DPR 
HD8  =  H1<CHD8<0PR 


WRITE«,700) 

FORMAT  (3X, 'LONGITUDINAL  AXIS  DIMENSIONAL  DERIVATIVES' ) 
WRITE  «,  703) 

FORMAT  (1SX, 'BODY  AXIS  (1/RAD)') 

WRITE«,710)  ZA,MA,  XA 

FORMAT (4X, *  ZA  *  ' ,613.6, 9X, 'HA  -  ' , 613.6, 6X, »XA  *  ',813.6) 
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o  o  o  o  o  o  n 


WRITE (*,720)  ZQ,MQ,XQ 

720  F0RMAT(4X,’ZQ  -  ’ ,013.6, 9X, 'MQ  -  » , 613.6, 6X, »XQ  -  ',813.8) 
WRITE (*,730)  ZH,HH, XH 

730  F0RHAT(4X, 'ZH  =  * ,813.6, 9X, 'MH  =  ’ ,613.6, 6X, 'XH  =  ’,613.6) 
WRITE (*, 740)  ZU,hU,XU 

740  F0RHAT(4X,»ZU  *  * ,613.6, 9X, 'MU  *  ’ ,613.6, 6X, » XU  -  ’,613.6) 
WRITE (*,750)  ZD1 ,MD1, XD1 

730  FORMAT (3X, ’ZD 1  -  ’ ,613.6, BX, »MD1  -  ’ ,613.6, 3X, ’XD1  -  ’,613.6) 
WRITE (*,760)  ZD2,MD2,XD2 

760  FORMAT (3X, ’ ZD2  =  » ,613.6, 8X, »MD2  =  ' ,613.6, 5X, ’ XD2  =  ’,613.6) 
WRITE(*,770)  ZD3, HD3, XD3 

770  FORMAT ( 3X, ’ZD3  *  ’ ,613.6, BX, ’MD3  *  » ,613.6, 5X, ' XD3  »  ’,613.6) 
WRITE (*,790)  ZD4,MD4, XD4 

780  F0RMAT(3X, ’ ZD4  =  ’ ,613.6, BX, 'MD4  =  » ,613.6, 5X, »XD4  *  »,G13.6) 
WRITE (*,790)  ZD5,MD3, XDS 

790  FORMAT (3X, ’ ZDS  =  ’ ,613.6, BX, ’MD5  =  ’ ,613.6, 5X, ’ XD5  =  ’,613.6) 
WRITE (*,800)  ZD6,MD6,XD6 

800  FORMAT (3X, ’ ZD6  =  » ,613.6, BX, ’MD6  *  ' ,613.6,5X, »XD6  =  ’,G13.6) 
WRITE(*,810)  ZD7,MD7,XD7 

810  FORMAT (3X, ’ ZD7  =  » ,613. 6,BX, »MD7  *  ’ ,613.6, 5X, »XD7  =  ’,613.6) 
WRITE (*,820)  ZD8,HD8,XD6 

820  FORMAT (3X, ’ ZDS  =  » ,613.6, 8X,*HDe  =  » ,613.6, 5X, ’ XD8  =  ’,613.6) 
WRITE(*,830) 

830  FORMATdX, » »*»<**»»*»»»«»«  *********************************** 
DEVELOPMENT  OF  STATE  MATRICES 
DEVELOPMENT  OF  THE  PLANT  MATRIX  -  A 
VT=U 

AMAT (1,1)  =  XU 
AMAT(1,2)  =  -VT*SAL 
AMAT (1,3)  =  XA 
AMAT (1,4)  =  -32.2*CTH 
AMAT (2, 1)  *  HU 
AMAT (2, 2)  *  MQ 
AMAT (2,3)  »  MA 
AMAT (2, 4)  *  0.0 
AMATO,  1)  «  ZU/VT 
AMATO, 2)  =  CAL 
AMATO, 3)  -  ZA/VT 
AMAT (3, 4)  *  -32.2*STH/VT 
AMAT (4, 1)  ■  0.0 
AMAT(4,2)  ■  1.0 
AMAT(4,3)  *  0.0 
AMAT (4, 4)  =  0.0 


WRITE(*,«) 

WRITE(*,850) 

830  FORMAT(’ 1’ , 3X, ’L0N6ITUDNAL  STATE  MATRIX (BODY  AXIS)') 
WRITE(*,«) 

WRITE (*,842) 


O  O  O  O  O  CJ 


942  FORMAT (»0',2X,» FOR  8TATE1-U, 8TATE2^,8TATE3-ALPHA,8TATE4-THETA* > 
WRITE!*,*) 

DO  855  1*1,4 

WRITE (*,860)  (AMAT ( I , J) , J*1 , 4> 

855  CONTINUE 

860  FORMAT (»0»,2X, 4(813.6, 4X)) 

WRITE(*,*) 

NOW  WE'LL  SET  THE  INPUT  MATRIX  -  B 

BMAT (1,1)  =  XD1 
BMAT(1,2)  *  XD2 
BMAT (1,3)  -  XD3 
BMAT (1,4)  -  XD4 
BMAT (1,5)  *  XD5 
BMAT (1,6)  *  XD6 
BHAT(1,7)  -  XD7 
BMAT (1,8)  *  XD8 
BMAT (2, 1)  -  MD1 
BMAT (2, 2)  -  MD2 
BMAT (2,3)  *  MD3 
BMAT (2, 4)  =  MD4 
BMAT (2,5)  *  MD5 
BMAT (2,6)  *  MD6 
BMAT(2,7)  =  MD7 
BMAT (2,8)  *  MD8 
BMAT(3, 1)  =  ZD1/VT 
BMAT(3,2)  -  ZD2/VT 
BMAT (3, 3)  *  ZD3/VT 
BMAT (3, 4)  *  ZD4/VT 
BMAT (3, 5)  =  ZD5/VT 
BMAT (3,6)  *  ZD6/VT 
BMAT (3, 7)  =  ZD7/VT 
BMAT (3,8)  *  ZD8/VT 
DO  865  1=1,8 
BMAT(4, I)  =  0.0 
)65  CONTINUE 

PRINT  OUT  THE  LONG  INPUT  MATRIX 

WRITE(*,*) 

WRITE (*,870) 

870  FORMAT (  *0* ,5X, ’LONGITUDNAL  INPUT  MATRIX*) 

WRITE!*,*) 

WRITE!*, 868) 

868  FORMAT (2X, * FOR  DELI  ■CANARD, DEL2=STAB, DEL3=TEF, DEL4=DR  AILERON’) 
WRITE!*, 869) 

869  FORMAT (2X,1  DEL5-RT  RV,  DEL6-RB  RV,  DEL7*LT  RV,  DEL8=LB  RV' ) 
WRITE!*,*) 

WRITE!*,*) 

WRITE!*, 871 ) 

871  FORMAT! *0’ ,5X, *R0W1* , 1 1 X , *RQW2* , 11X, *R0W3* , 11X, *R0W4* ) 

WRITE!*,*) 


DO  872  1*1,8 

WRITE (*,880)  (BHAT(J, I), J=l,4) 

872  COKTINUE 
WRITE!*,*) 

873  CONTINUE 
URITE(*  873) 

873  FORMAT! IX, »  DO  YOU  WANT  STAB  AXIS  DATA  FOR  L0N6?(Y/N)») 
READ!*, 874)  STAB1 

874  FORMAT !A1) 

IF  !  STAB1  .EQ.  »Y»  )  GO  TO  877 
IF  !  STAB1  .EQ.  »N»  )  60  TO  857 
GO  TO  875 
877  CONTINUE 


f 

:tm****m<*****<*m****mm«****m»*mmM»m<**** 

C*!!!!!!!  * 

C*!  CONVERT  BODY  AXIS  DATA  TO  STABILITY  AXIS!  * 

C*!  (FOR  CHECK  WITH  HCAIR  DATA)!!  * 

C*( (!!((!  * 

C*((((((!  * 

C***!******************************************************* 

C 

SMU  ■(  MU*CAL  +  !MA/U)«SAL*CAL) 

SMH  *(  (  SMU  /  MU  )  *  MH  ) 

SNA  ■(  MA  *  COSSQ  -  MU  *  U  *  SAL  ) 

SMQ  *  HQ 
SMD1  =  MD1 
SMD2  *  MD2 
SMD3  *  MD3 
SHIM  -  MD4 
SMD5  -  MD5 
SHD6  *  MD6 
SMD7  *  MD7 
SMD8  -  ND8 
C 

SXU»XU*COSSQ+ ( Z A/U ) *S I NSQ*CAL+ ( ( XA/U ) *CAL+ ZU >  *SAL*CAL 
SXH  -  !SXU/XU)«XH 

SXA  *  XA*CAL**3  -U*ZU*SINSQ  -  (U*XU  -  ZA*CAL)*CAL*SAL 
SXQ  -(  XQ*CAL  +  ZQ*SAL  ) 

SXD1  *  !XD1*CAL  +  ZDltSAL) 

8XD2  -(  XD2*CAL  +  ZD2*SAL) 

SXD3  *  ( XD3*CAL  +  ZD3*SAL) 

8XD4  -  (XD4*CAL  +  ZD4*SAL) 

SXD5  *  (XD5*CAL  +  ZD5*SAL) 

SXD6  -  (XD6*CAL  +  ZD6*SAL) 

SXD7  *  (XD7*CAL  +  ZD7*SAL) 

SXD8  *  !XD8*CAL  +  ZD8*SAL) 

C 

SZU-ZU*C088Q- ( XA/U) *S IN8Q*CAL- ( XU- ( ZA/U) *CAL) *8AL*CAL 
8ZH  -  (SZU/ZU)  *  ZH 

SZA»ZA*CAL**3  +  U*XU*SINSQ  -  (U*ZU  ♦  XA*CAL)*CAL*SAL 
SZQ  *  !ZQ*CAL  -  XQ*SAL) 

SZD1  -  (ZD1*CAL  -  XD1*SAL) 


8202  -  (ZD28CAL  -  XD2*8AL) 

8203  -  (ZD3*CAL  -  XD3*SAL) 

SZD4  -  (ZD4*CAL  -  XD4«8AL> 

8206  «  (ZD5*CAL  -  XD5*SAL) 

8206  -  <ZD6*CAL  -  XD6*SAL> 

8207  -  (ZD7*CAL  -  XD7*SAL) 

SZD8  =  (ZD8*CAL  -  XD8*SAL) 

WRITE (*,701) 

701  FORMAT  <*0’ ,5X, 'LONGITUDINAL  AXIS  DIMENSIONAL  DERIVATIVES') 
WRITE(*,702) 

702  FORMAT  <1SX,'  STABILITY  AXIS  (1/RAD)  ») 

WRITE(*,711)  SZA,SMA,SXA 

711  F0RMAT(4Xf»2A  »  ' ,613.6, 9X, 'MA  *  ' ,613.6, 6X, »XA  -  ',613.6) 
WRITE(*,721)  SZQ,SMQ,SXQ 

721  F0RMAT(4X,»ZQ  *  ' ,613.6, 9X, 'MQ  =  ' ,613.6, 6X, 'XQ  *  »,613.6) 
WRITE (*,731)  SZH,SMH,SXH 

731  FORMAT (4X, » 2H  =  » ,613.6, 9X, 'MH  *  ' ,613.6, 6X, »XH  =  ',613.6) 
WRITE(*,741)  SZU,SHU,SXU 

741  F0RMAT(4X,»ZU  ■  ' ,613.6, 9X, 'MU  *  » ,613.6, 6X, » XU  =  », 613.6) 
WRITE(*,7S1)  SZD1 , SMD1 , SXD1 

751  FORMAT (3X, » ZD1  ■  » ,613.6, 8X, »MD1  =  ' ,613.6, 5X, ' XD1  =  ',613.6) 
URITE(*, 761)  SZD2, SM02, SXD2 

761  FORMAT (3X, » 2D2  =  ' ,613.6, BX, 'MD2  =  ' ,613.6, 5X, » XD2  =  ',613.6) 
WRITE (*,771)  SZD3, SMD3, SXD3 

771  FORMAT (3X, ' 2D3  =  ' ,613.6, 8X, 'MD3  =  ' ,613.6, 5X, »XD3  *  ',613. 6) 
WRITE(*,781)  S2D4,SMD4,SXD4 

781  FORMAT (3X,»ZD4  =  ' ,613.6, BX, »MD4  *  ' ,613.6, 5X, »XD4  *  », 613.6) 
WRITE(*,791)  SZD5,SMD5,SXDS 

791  FORMAT (3X, » 2D5  -  ' ,813.6, 8X, 'HD5  ■  ' ,813.6, 3X, 'XD5  -  », 813.6) 
WRITE (*,800)  S2D6 , SMD6 , SXD6 

801  FORMAT  (3X, '  ZD6  =  » ,613.6,  BX,  'MD6  =  '  ,613.6, 5X, '  XD6  ■=  ',613.6) 
WRITE(*,811)  S2D7 , SMD7, 8X07 

811  FORMAT (3X, » ZD7  *  » ,613.6, 8X, 'MD7  *  ' ,613.6,3/, »XD7  =  ',613.6) 
WRITE(*,820)  SZD8, SMD8, SXD6 

821  FORMAT (3X,'ZD8  *  » ,813.6, 8X, 'MD8  *  ' ,613.6, 5X, 'XD8  -  ',613.6) 
WRITE (*,830) 

880  F0RMAT(2X,4(813.6,2X) ) 

C 

AMAT (1,1)  «  SXU 
AMAT (1,2)  *  0.0 
AHAT(1,3)  =  SXA 
AMAT(1,4)  -  -32.2*CTH 
AMAT (2,1)  >  SMU 
AMAT (2,2)  =  SMQ 
AMAT (2, 3)  =  SMA 
AMAT (2,4)  *  0.0 
AMATO,  1)  =  SZU/U 
AMATO, 2)  =  1.0 
AMAT (3, 3)  -  SZA/U 
AMATO, 4)  *  -32.2*STH/U 
AMAT (4, 1 )  *  0.0 
AMAT (4, 2)  *  1.0 
AMAT(4,3)  -  0.0 
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Py 


cm 


AMAT (4,4)  ■  0.0 
WRITE (*,851) 

F0RMATC0’  ,5X,  ’L0N6ITUDNAL  STATE  MATRIX  (STAB  AXIS)’) 
WRITE!*,*) 

WRITE (*,842) 

WRITE(*,*) 

DO  8S6  1=1,4 

WRITE (*,860)  (AMATd,  J),  J*l,4) 

CONTINUE 

CONTINUE 

IF  (KEY  .EB.  ’BOT’  )  60  TO  446 
IF  (KEY  .EQ.  ’GAM’  )  GO  TO  1465 
CONTINUE 
WRITE (*,430) 

FORMAT (IX, » IS  ANOTHER  PROGRAM  RUN  DESIRED  ?  (YES/NO)*) 
READ (*,440)  RUN 
FORMAT (A3) 

WRITE (*,445) 

FORMATdX,  >««»»*««*<**»*************«**<****»*<***: 

IF (RUN  .EQ.  'NO  ’)  GO  TO  450 

IF (RUN  .EQ.  ’YES’)  60  TO  103 

GO  TO  421 

CONTINUE 

THIS  IS  WHERE  THE  LATERAL  DIRECTIONAL  STARTS 


WRITE (*, 1110) 

>  FORMATdX,  ’CLB 
READ(*t*)  CLB 
WRITEU,  1120) 

>  FORMATdX,  ’CNB 
READ(*,*)  CNB 
WRITE!*, 1130) 

>  FORMATdX, 'CYB 
READ(*,*)  CYB 
WRITE(*, 1140) 

)  FORMATdX, ’CLP 
READ(*,*)  CLP 
WRITECt, 1150) 

>  FORMATdX,  ’CNP 
READ(*,*>  CNP 
WRITE(*, 1160) 

>  FORMATdX, ’CYP 
READ!*,*)  CYP 
WRITE(*, 1170) 

>  FORMATdX,  »CLR 
READ(*,*)  CLR 
WRITE(*, 1180) 

>  FORMATdX, ’CNR 
READ(*,*)  CNR 
WRITE!*, 1190) 

I  FORMATdX,  ’CYR 
READ!*,*)  CYR 


(1/DEG)  = 


(1/DEG) 


(1/DEG) 


(1/DEG) 


(1/DEG) 


(1/DE6) 


(1/DEG) 


(1/DEG) 


(1/DEG) 


s  . 


/  .*  /.  >* 


URITEC*, 1200) 

1200  F0RMATC1X,»CLD1  Cl/DEG)  - 
READC*,*)  CL01 
URITEC*, 1210) 

1210  FORMAT (1X,»CND1  (1/DEG)  = 
READC*,*)  CND1 
URITEC*, 1220) 

1220  FORMAT (1X,’CYD1  (1/DEG)  « 
READC*,*)  CYD1 
URITEC*, 1230) 

1230  FORMAT (1X,»CLD2  (1/DEG)  » 
READ(*,*)  CLD2 
URITEC*, 1240) 

1240  F0RMATC1X, fCND2  (1/DEG)  * 
READC*,*)  CND2 
URITEC*, 1250) 

1250  FORMAT (1X,»CYD2  (1/DEG)  * 
READC*,*)  CYD2 
URITEC*, 1260) 

1260  FORMAT (1X,’CU)3  (1/DEG)  = 
READC*,*)  CLD3 
URITEC*, 1270) 

1270  FORMAT (1X,»CND3  (1/DEG)  * 
READC*,*)  CND3 
URITEC*, 1280) 

1280  FORMAT (1X,»CYD3  (1/DEG)  * 
READC*,*)  CYD3 
URITEC*, 1290) 

1290  F0RMATC1X, ' CLD4  (1/OEG)  ■ 
READC*,*)  CLD4 
URITEC*, 1300) 

1300  FORMAT (1X,’CND4  Cl/DEG)  = 
READC*,*)  CND4 
URITEC*, 1310) 

1310  FORMAT C1X,»CYD4  (1/DEG)  « 
READC*,*)  CYD4 
URITEC*, 1320) 

1320  F0RMATC1X, fCLD5  (1/DEG)  * 
READC*,*)  CLD5 
URITEC*, 1330) 

1330  FORMAT (1X,»CND5  (1/DEG)  - 
READC*,*)  CND5 
URITEC*,  1340) 

1340  FORMAT (1X,»CYD5  Cl/DEG)  = 
READC*,*)  CYD5 
URITEC*, 1350) 

1350  FORMAT C1X,'CU)6  (1/DEG)  ■ 
READC*,*)  CLD6 
URITEC*, 1360) 

1360  FORMAT (1X,»CND6  Cl/DEG)  * 
READC*,*)  CND6 
URITEC*, 1370) 

1370  FORMAT ( 1 X, ’CYD6  Cl/DEG)  > 


READ(*,*)  CYD6 
WRITEC*, 1380) 

FORMAT (1X,'CLD7  (1/DEG)  =  '  ) 

READ(*,*)  CLD7 
WRITEC*, 1390) 

FORMAT ( 1 X, 'CND7  (l/DEG)  *  ') 

READC*,*)  CND7 
WRITEC*, 1400) 

FORMAT (1 X, 'CYD7  (l/DEG)  ■  ') 

READC*,*)  CYD7 
WRITEC*, 1410) 

FORMATdX, 'CLD8  (l/DEG)  -  ») 

READC*,*)  CUM 
WRITEC*, 1420) 

FQRMATCIX,  'CND8  (l/DEG)  •  ') 

READC*,*)  CND8 
WRITEC*, 1430) 

FORMATdX,  'CYD8  (l/DEG)  -  ') 

READC*,*)  CYDfi 
WRITEC*, 1440) 

FORMATdX,  'CLD9  (l/DEG)  «  '  ) 

READ(*,*)  CLD9 
WRITEC*, 1430) 

FORMAT (IX, *CND9  (l/DEG)  -  ») 

READ(*,*)  CND9 
WRITEC*, 1460) 

FORMATdX, 'CYD9  (l/DEG)  •  ') 

READ(*,*)  CYD9 
CONTINUE 
URITE(*y 1470) 

FORMAT ( ' 1 ' , 8X , ' LAT-D IR  BODY  AXIS  COEFFICIENTS') 

IF (KEY  .EQ.  'LON')  80  TO  1490 
IF (KEY  . EQ.  »BOT')  60  TO  1490 
WRITEC*, 1400)  DALPHA 
FORMAT (13X, 'ALPHA  -  ’y613.6) 

CONTINUE 

WRITEC*, 1300)  CLB,CNB,CYB 
FORMAT (3X,»CLB  -  ' ,013. 6, 8X, 'CNB  >  ' ,613.6, 3X, 'CYB  -  ',813.6) 
WRITEC*, 1310)  CLP,CNP,CYP 

FORMAT (3X, 'CLP  *  ' ,613. 6, 8X, 'CNP  -  ' ,813.6, 5X, 'CYP  *  ',613.6) 
WRITEC*, 1320)  CLR,CNR,CYR 

FORMAT (3X,*CLR  -  * ,813.6, 8X, 'CNR  -  ' ,613.6, 5X, »CYR  -  ',613.6) 
WRITEC*, 1330)  CLD1, CND1,CYD1 

FORMAT (2X,'CLD1  >  ' ,613.6, 7X, 'CND1  -  ' ,813.6, 4X, 'CYD1 
WRITE (*,1540)  CLD2, CND2, CYD2 

FORMAT (2X,'CU)2  ■  ' ,613.6, 7X, 'CND2  =  ' ,613.6, 4X, 'CYD2 
WRITEC*, 1550)  CLD3, CND3, CYD3 

FORMAT (2X,'CU)3  -  ' ,613.6, 7X, 'CND3  -  ' ,613.6, 4X, 'CYD3 
WRITEC*, 1360)  CLD4,CND4,CYD4 

FORMAT C2X,' CLD4  ■  ' ,813.6, 7X, 'CND4  -  », 813.6, 4X,»CYD4 
WRITEC*, 1570)  CLD5, CND3,CYD3 

FORMAT (2X,'CU)3  «  ' ,813.6, 7X, 'CND3  *  ' ,813.6, 4X, 'CYD3 
WRITEC*, 1380)  CLD6,CND6,CYD6 


', 813.6, 4X,'CYDl  ■  ',613.6) 


',813.6) 


-  ' ,613.6, 4X, 'CYD3  -  ',813.6) 

-  ' ,813.6, 4X, 'CYD4  -  ',813.6) 
»  * ,613. 6, 4X, *CYDS  >  ',613.6) 


1300  FORMAT <2Xy * CLD6  -  ’ ,013.6, 7X, ’CND6  -  » ,013.6, 4X, ’CYD6  -  ’,013.6) 
URITE(«, 1990)  CLD7,CND7,CYD7 

1390  FORMAT (2X,’CL07  »  ’ ,013.6, 7X, ’CND7  =  ’ ,013.6, 4X, ’CYD7  «  *,013.6) 
WRITECt, 1600)  CLD8,CND8,CYD8 

1600  FORMAT ( 2X, ’CL08  >  ’ ,013.6, 7X, ’CND8  -  ’ ,013.6, 4X, ’CYD0  *  ’,013.6) 
WRITEC*, 1610)  CLD9,CND9,CYD9 

1610  FORMAT (2X,’CLD9  -  ’ ,013.6, 7X, ’CND9  ■  ’ ,013.6, 4X, ’CYD9  «  ’,013.6) 
URITE<*,«) 

WRITEC*, 1620) 

1620  FORHAT(ix,’»«»««nitM»mm»w«ii»w»»<m»nim’ 
1623  CONTINUE 

WRITEC*,  1630) 

1630  FORMATdX, ’ IS  THE  ENTERED  DATA  CORRECT  ?  (YES/NO)’) 

READC*, 1640)  DATA2 
1640  FORMAT (A3) 

IF  (  DATA2  .EQ.  ’NO’)  00  TO  446 
IF  (  DATA2  .EQ.  ’YES’  )  00  TO  1643 
00  TO  1625 

1645  CONTINUE 
WRITE  Ct,  1646) 

1646  FORMATdX, ’DO  YOU  WANT  STAB  AXIS  DATA  FOR  LAT-DIR?  (Y/N)*) 
READC*, 1647)  STAB2 

1647  FORMAT  < A1 ) 

IF  (  STAB2  .EQ.  ’N*)  00  TO  1801 
IF  (  STAB2  .EQ.  ’Y’)  00  TO  1648 
80  TO  1645 

1648  CONTINUE 
BSALPH=-ALPHA 
C8A-C08CB8ALPH) 

SSA-SIN(BSALPH) 

CS-CSA*CSA 

SS=SSA*SSA 

C 

SCLP=CLP*CS  +  CNR*SS  -  (CLR  +  CNP)*CSA*SSA 
SCLR-CUWCS  -  CNP*SS  +  (CLP  -  CNR)*CSA*SSA 
SCLB=CLBtCSA  -  CNBtSSA 
SCLDl*CLDltCSA  -  CNDUSSA 
SCLD2=CLD2*CSA  -  CND2*SSA 
SCLD3-CLD3*CSA  -  CND3*SSA 
SCLD4=CLD4*CSA  -  CND4*SSA 
SCLD5-CLD3*CSA  -  CND5*SSA 
SCLD6=CLD6*CSA  -  CND6*SSA 
SCLD7-CU)7*CSA  -  CND7*SSA 
SCLD8«CLD8*CSA  -  CND8*SSA 
SCLD9-CLD9*CSA  -  CND9*SSA 
C 

SCNP=CNP*CS  -  CLR*SS  +  (CLP  -  CNR)*CSA*SSA 
SCNR«CNR*CS  ♦  CLPtSS  ♦  (CLR  ♦  CNP)*CSA*SSA 
SCNB=CNB*CSA  +  CLBtSSA 
SCND1-CND1*CSA  ♦  CLD1*SSA 
SCND2-CND23CSA  ♦  CLD2*SSA 
SCND3-CND3tCSA  ♦  CLD3TSSA 
SCND4-CND4*CSA  +  CLD44SSA 


SCND7«CND7*CSA  +  CLD7*SSA 
SCNDO-CNDetCSA  +  CLD8*88A 
SCND9-CND9*CSA  ♦  CLD9*SSA 

SCYP«CYP*CSA  -  CYRtSSA 
SCYR-CYR*CSA  ♦  CYP*SSA 
8CYB-CYB 
WRITE!*, 1471) 

1471  FORMAT !  8X , ' LAT-DIR  STAB  AXIS  COEFFICIENTS') 

WRITE (*, 1501)  SCLB,SCNB, SCYB 

1901  FORMAT !3X,»CLB  -  » , 813.6, BX, »CNB  -  » ,813.6, 5X, 'CYB  -  ',813.6) 
WRITE!*,  1511)  SCLP,  SCNP,  SCYP 

1911  FORMAT (3X, 'CLP  -  ’ ,813.6, 8X, 'CNP  =  » ,813.6, 5X, »CYP  *  ',813.6) 
URITEU,  1521)  SCLR,SCNR,3CYR 

1921  F0RMAT(3X,'CLR  -  ' ,813,6, BX, 'CNR  -  » ,613.6, 5X, »CYR  ■  ',613.6) 
WRITE!*, 1931)  SOLDI, SCND1 ,CYD1 

1931  FORMAT (2X,'CLD1  -  » ,613.6, 7X, »CND1  -  » ,613.6, 4X, »CYD1  >  ',813.6) 
WRITE <*, 1541)  SCLD2, SCND2 , CYD2 

1541  FORMAT (2X, 'CL02  »  » ,613.6, 7X, 'CND2  -  » ,613.6, 4X, »CYD2  *  ',613.6) 
WRITE <*, 1591)  8CLD3 , 8CND3 , CYD3 

1991  FORMAT <2X,»CLD3  *  ' ,613.6, 7X, 'CND3  =  ' ,813.6, 4X, 'CYD3  *  ',613.6) 
WRITEC*, 1961)  SCLD4 , SCND4 , CYD4 

1961  F0RMAT(2X,’CU>4  -  ' ,813.6, 7X, »CND4  -  » ,813.6, 4X, 'CYD4  -  ',613.6) 
WRITE!*, 1571)  8CLD5, 8CND9,CYD9 

1571  F0RMAT(2X,'CLD5  *  » ,613.6, 7X, »CND8  «  » ,613.6, 4X, 'CYD5  »  », 613.6) 
WRITE!*, 1581)  SCLD6, SCND6, CYD6 

1561  FORMAT !2X,'CL06  =  ' ,613.6, 7X, 'CN06  =  » ,613.6,4X, »CYD6  -  ',613.6) 
WRITE!*, 1591)  SCLD7 , 8CND7 , CYD7 

1591  FORMAT !2X,»CLD7  =  ' ,813.6, 7X, 'CND7  =  » ,613.6, 4X, 'CYD7  *  »,613.6) 
WRITE!*. 1601)  SCLD8.SCND8.CYD6 

1601  FORMAT !2X, ’ CLOG  «  ' ,613.6, 7X, ’CN08  -  ' ,613.6, 4X, »CYD8  -  ',613.6) 
WRITE!*, 1611)  8CLD9, SCND9, CYD9 

1611  FORMAT !2X,'CLD9  -  ’ ,813.6, 7X, 'CND9  ■  ' ,613.6, 4X, 'CYD9  >  ',613.6) 
WRITE!*,*) 

SIXX-BIXX*CQ8SQ  +  BIZZtSINSQ  -  BIXZ*8IN!2*ALPHA) 

SIYY-BIYY 

SIZZ«BIZZ*COBSQ  +  BIXX*SINSQ  +  BIXZ*SIN!2*ALPHA) 
SIXZ-BIXZ*C0S!2*ALPHA)  +  ,5*!BIXX  -  BIZZ)*SIN!2*ALPHA) 

SN  -  DPR*!Q*S*B)/SIZZ 
SL  -  DPR*!B*S*B)/SIXX 
SB  -  B/ (2.0*U) 

SY  =  DPR*!Q*S*32.2)/W 
SNB  =  SN*SCNB 
SNP  >  SN*8B*SCNP 
SNR  -  SN*SB*SCNR 
SND1  -  SN*SCND1 
SND2  «  SN*SCND2 
SND3  «  SN*SCND3 


*:  ti 


SND7  «  SN*SCND7 
SND6  -  SN*SCND6 
SND9  «  SN*SCND9 


SLB  = 

SLP  ■ 

SLR  - 

SLD1 

SLD2 

SLD3 

SLD4 

8LD5 

SLD6 

SLD7 

SL08 

SLD9 


SLtSCLB 

SL*SB*SCLP 

3L*SB*SCLR 

-  SLtSCLDl 

-  SL*SCLD2 

-  SL*SCLD3 
=  SL*SCLD4 

-  SL*SCLDS 
*  SL*SCLD6 

-  SL*SCLD7 
■  SL*SCLD8 
«  SL*SCLD9 


SYB  - 
SYR  * 
SYP  = 
SYD1  « 
SYD2  = 
SYD3 
SYD4 
SYD3 
SYD6 
3YD7 
SYD8 
SYD9 


SYtSCYB 
SY*SB*SCYR 
SY*SB*SCYP 
«  SY*  CYD1 
•  SY*  CYD2 
'  SY*  CYD3 
»  SY*  CYD4 

>  SY*  CYD5 

■  SY*  CYD6 

>  SY*  CYD7 

■  SY*  CYD8 

>  SY*  CYD9 


WRITE  (*, 1661) 

F0RMAT!5X,»LAT-DIR  STAB  AXIS  DIMENSIONAL 

WRITE!*, 1671)  SN8, SLB, SYB 

FORMAT (4X, 'NB  -  * ,813.6, 9X, 'LB  *  ',613.6, 

WRITE!*, 1681)  SNP,SLP,SYP 

F0RMAT!4X,»NP  «  » ,613.6, 9X, 'LP  =  ',613.6, 

WRITE!*, 1691)  SNR, SLR, SYR 

F0RMAT!4Xf 'NR  -  » ,613.6, 9X,'LR  «  ',613.6, 

WRITE!*, 1701)  SND1,SLD1,SYD1 

FORMAT !3X,'ND1  >  ' ,613.6, BX, 'LD1  =  ',613. 

WRITE!*, 1711)  SND2,SLD2,SYD2 

FORMAT !3X,'ND2  -  ' ,613.6, 8X, 'LD2  -  ',613. 

WRITE!*, 1721)  SND3 , SLD3 , 5YD3 

FORMAT !3X, *ND3  *  * ,613.6, 8X, 'LD3  =  ',613. 

WRITE!*, 1731)  SND4,SLD4,SYD4 

FORMAT !3X,'ND4  =  ' ,613.6, 8X, 'LD4  *  ',613. 

WRITE!*, 1741)  SND3,SLD3,SYD3 

FORMAT !3X,'ND5  *  » ,613.6, 8X, 'LD5  «  ',613. 

WRITE!*, 1731)  SND6,SLD6,SYD6 

FORMAT !3X,'ND6  -  ' ,613.6, 8X, 'LD6  »  ',613. 

WRITE!*, 1761)  SND7 , SLD7 , SYD7 


DERIVATIVES! 1/RAD) ' ) 


', 613.6, 5X,'YB  =  ',613.6) 


5X,'YP  =  ',613.6) 
5X,'YR  *  ',613.6) 


', 613.6, 4X,'YD1  =  ',613.6) 
' ,613. 6, 4X, 'YD2  =  ',613.6) 


6,4X, ' YD3  -  ',613.6) 
6,4X, ' YD4  *  ',613.6) 
6,4X, ' YD5  =  ',613.6) 
6,4X,'YD6  «  ',613.6) 


1761  FORMAT (3X,*ND7  «  * , 613. 6, 8X, *LD7 
WRITEOt, 1771)  SND8, SLD8t  SYD8 
1771  FORMAT (3X,*NDG  -  * ,613.6, 8X, 'LD8 
WRITE (*, 1781)  SND9,SU)9,SYD9 
1781  FORMAT <3X,*ND9  -  ' ,613.6, BX, 'LD9 

WRITE (*, 1650) 

1650  FORHATdx^ftmwmmimwi 
1801  CONTINUE 

N  -  DPR*CQ*S*B)/BIZZ 
L  «  DPR*<Q*S*B)/BIXX 
BB  »  B/<2.0*U) 

Y  -  DPR* <0*8*32. 2) /W 
BNB  ■  NtCNB 
BNP  -  N*BB*CNP 
BNR  ■  N*BB*CNR 
BND1  ■  N*CND1 
BND2  -  N*CND2 
BND3  -  N*CND3 
BND4  -  N*CND4 
BND5  >  N*CND5 
BND6  -  N*CND6 
BND7  >  N*CND7 
BNDG  ■  N*CND8 
BND9  ■  N*CND9 


' ,613. 6, 4X, 'YD 7  -  *,613.6) 
* ,613.6, 4X,*YD8  »  *,613.6) 
’ ,613.6, 4X, *YD9  -  *,613.6) 


BLB  a 

BLP  « 

BLR  = 

BLD1 

BLD2 

BLD3 

BUM 

BLDS 

BLD6 

BLD7 

BLDG 

BLOB 

BYB  - 

BYR  - 

BYP  ■ 

BYD1 

BYD2 

BYD3 

BYD4 

BYD5 

BYD6 

BYD7 

BYD8 

BYDB 


L*CLB 
LtBBtCLP 
L*BB*CLR 
«  L*CLD1 

■  L*CLD2 

-  L*CLD3 
*  L«CLD4 
«  L*CLD5 
=  L*CLD6 

■  L*CLD7 

-  L*CLDG 

■  L*CLD9 

Y*CYB 

Y*BB*CYR 

Y*BB*CYP 

■  Y*CYD1 
=  Y*CYD2 

■  Y*CYD3 
«  Y*CYD4 
=  Y*CYD5 

■  Y*CYD6 

■  Y*CYD7 

■  Y*CYDG 
«  Y*CYD9 


WRITE (*, 1660) 


o  o  o  o  o 


1660  FORMAT (5X,»LAT-DIR  BODY  AX 18  DIMEN8I0NAL  DERIVATIVES! 1/RAD) * ) 
WRITE!*, 1670)  BNB,BLB,BYB 

1670  FORMAT (4X, 'N8  «  * , 613.6, 9X, 'LB  *  * , 613.6, 5X, *YB  *  ' ,613.6) 
WRITE!*, 1680)  BNP,BLP,BYP 

1680  FORMAT (4X,  'HP  »  »,G13.6,9X, 'LP  ■  *  ,813.6,5X,  *YP  ■  *,613.6) 
WRITE!*, 1690)  BNRjBLR, BYR 

1690  FORMAT (4X, 'NR  *  ’ ,613.6, 9X,  fLR  *  ' ,613.6, SX, *YR  *  *,613.6) 


WRITE!*, 1700)  BND1, BLD1, BYD1 

1700  F0RMAT(3X, *ND1  »  ' ,613.6, 8X, *LD1  ■  * ,813.6, 4X, *  YD 1  =  *,613.6) 
WRITE!*, 1710)  BND2, BLD2, BYD2 

1710  FORMAT (3X,*ND2  »  ' ,613.6, 8X, *LD2  ■  * ,613.6, 4X, *YD2  *  *,613.6) 
WRITE!*, 1720)  BND3, BLD3, BYD3 

1720  FORMAT !3X,*ND3  -  * ,613.6, 8X, *LD3  -  * ,613.6, 4X, *YD3  «  *,613.6) 
WRITE!*, 1730)  BND4,BLD4, BYD4 

1730  FORMAT !3X,'ND4  =  * ,613.6, 8X, »LD4  *  * ,613.6, 4X, 'YD4  =  *,613.6) 
WRITE!*, 1740)  BND5, BLDS, BYDS 

1740  FORMAT !3X, *NDS  *  * ,613.6, 8X, »LD3  *  * ,613.6, 4X, 'YDS  =  *,613.6) 
WRITE!*, 1750)  BND6, BLD6, BYD6 

1750  FORMAT !3X,'ND6  ■  * ,613.6,8X, *LD6  =  * ,613.6, 4X, *YD6  =  *,613.6) 
WRITE!*, 1760)  BND7,BLD7,BYD7 

1760  FORMAT !3X,»ND7  =  ’ ,613.6, 8X, *LD7  *  * ,G13.6,4X, *YD7  *  *,613.6) 
WRITE!*, 1770)  BND8, BLD8, BYD8 

1770  FORMAT !3X, *ND8  ■  » ,613.6, 8X, »LD8  -  ' ,613.6, 4X, *YD8  =  *,613.6) 
WRITE!*, 1780)  BND9,BLD9,BYD9 

1780  FORMAT !3X,*ND9  *  • ,613.6, 8X, *LD9  *  ' ,613.6, 4X, *YD9  *  *,613.6) 
WRITE!*, 1790) 

1790  F0RMAT!1X, 't****************************************************  > 
WRITE!*, 1800) 

1800  FORMAT! IX, * t**************************************************** > 


CONVERSION  OF  DATA  INTO  STATE  SPACE  FORM 


D  *  1.0  -  ! (BIXZ*BIXZ)/!BIXX*BI2Z) ) 
R1  =  BIXZ/BIZZ 
R2  =  BIXZ/BIXX 
C 

PBNB  -  CBNB  ♦  R1*BLB)/D 
PBNP  *  (BNP  +  R1*BLP)/D 
PBNR  »  (BNR  ♦  R1*BLR)/D 
PBND1  »  (BND1  *  R1*BLD1)/D 
PBND2  «  (BND2  +  R1*BLD2)/D 
PBND3  »  !BND3  ♦  R1*BLD3)/D 
PBND4  =  (BND4  +  R1*BLD4)/D 
PBNDS  «  (BND5  ♦  R1*BLD5)/D 
PBND6  =  (BND6  +  R1*BLD6)/D 
PBND7  *  (BND7  ♦  R1*BLD7)/D 
PBND8  =  (BND8  ♦  R1*BLD8)/D 
PBND9  -  !BND9  ♦  R1*BLD9)/D 
PBLB  -  (BLB  *  R2*BNB)/D 
PBLP  «  (BLP  ♦  R2*BNP)/D 
PBLR  «  (BLR  +  R2*BNR)/D 
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o  o  o  o  o  on 


PBLD1  -  (BLD1  ♦  R2*BN01)/D 
PBLD2  »  (BLD2  +  R2*BND2)/D 
PBLD3  -  CBL03  ♦  R2*BND3)/D 
PBLD4  *  (BLD4  +  R2*BND4)/D 
PBLDS  -  (BLOS  ♦  R2*BND5)/D 
PBLD6  «  (BLDG  +  R2*BND6)/D 
PBLD7  -  (BL07  ♦  R2*BND7)/D 
PBLOfl  -  (BLDG  +  R2*BND8)/D 
PBLDS  >  (BLDS  ♦  R2*BNDS)/D 

C 

PBYB  «  BYB/U 
PBYP  «  SAL 
PBYR  -  -CAL 
PBYPHI  -  32.2TCTH/U 
PBYD1  «  BYD1/U 
PBYD2  ■  BYD2/LI 
PBYD3  «  BYD3/U 
PBYD4  •  BYD4/U 
PBYDS  -  BYDS/U 
PBYD6  -  BYD6/U 
PBYD7  ■  BYD7/U 
PBYD8  -  BYDG/U 
PBYDS  «  BYDS/U 

C 

C(  LATERAL  DIRECTIONAL  STATE  MATRIX 


DO  1805  1-1,5 
DO  1806  J-1,5 
1806  DIRMATd,  J>-0.0 
1805  CONTINUE 

DIRMATd,  3)«1.0 
DIRMAT(2,1)-PBYPHI 
DIRMAT(2,2)-PBYB 
DIRMAT(2,3)-PBYP 
DIRHAT(2,4)-PBYR 
DIRMAT(2, 5) -32. 2*8TH/U 
DIRHAT(3,2)-PBLB 
DIRMAT (3,3)-PBLP 
DIRMAT(3,4)«PBLR 
DIRMAT(4,2)-PBNB 
DIRMAT  (4, 3>-PBNP 
DIRMAT (4,4)  -PBNR 
DIRMAT (5, 4) -1.0 


OUTPUT  THE  STATE  MATRIX 


WRITE(*,B30> 

URITE(*, 1810) 

1810  FORMAT <'1',2X,» LATERAL  DIRECTIONAL  STATE  MATRIX') 
URITECt, 1820) 


o  n  o  o  o  o  o 


1020  FORMAT (’O' | SX | ’STATES  ■  PHI, BETA, P,R,P8I» ) 
WRITE!*,*) 

WRITE!*, 182S)  CDIRHAT ( 1 , I > , 1=1 , S) 

WRITE!*, 1825)  !DIRMAT!2, I ) , 1*1,3) 

WRITE!*, 1823)  !DIRHAT!3, I), 1-1,5) 

WRITE!*, 1823)  !DIRMAT!4, I), 1*1,3) 

WRITE!*, 1823)  !DIRHAT!3, I), 1=1,3) 
WRITE!*,*) 

1823  F0RMAT!»0» ,2X,3!611.4,4X)  ) 

LATERAL  DIRECTIONAL  INPUT  MATRIX 


DO  1830  1-1,9 
DIRBNAT! 1, I) -0.0 
DIRBNAT !S, I ) -0. 0 
1830  CONTINUE 

DIRBNAT!2,  D-PBYDl 
DIRBNAT!2,2)-PBYD2 
DIRBNAT  !2,  3)=f>BYD3 
DIRBNAT !2, 4) -PBYD4 
DIRBNAT !2,5)-PBYD5 
DIRBNAT ! 2, S)-PBYD6 
DIRBNAT !2, 7)-PBYD7 
DIRBNAT !2,8)-PBYD8 
DIRBNAT !2, 9) -PBYD9 
DIRBNAT (3,  D-PBNDl 
DIRBNAT!3,2)-PBND2 
DIRBHAT!3,3)-PBND3 
DIRBNAT !3, 4>«PBND4 
DIRBNAT !3, 5) -PBND5 
DIRBNAT !3, 6) -PBND6 
DIRBNAT !3, 7) -PBND7 
DIRBNAT !3,8)=PBND8 
DIRBNAT !3, 9) -PBND9 
DIRBNAT !4,1)=PBLD1 
DIRBNAT !4,2)=PBLD2 
DIRBNAT (4, 3) -PBLD3 
DIRBNAT ! 4, 4) -PBLD4 
DIRBNAT !4, 3) -PBLD3 
DIRBNAT!4,6)-PBLD6 
DIRBNAT !4, 7)  =RBLD7 
DIRBNAT !4, 8) -PBLD8 
DIRBHAT!4,9)-PBLD9 

PRINT  OUT  THE  INPUT  MATRIX 

WRITE!*, 1850) 

1850  FORMAT !» O', 2X,» LATERAL  DIRECTIONAL  INPUT  MATRIX') 

WRITE!*  1860) 

I860  FORMAT !» O', 4X,» FOR  INPUTS*  DELI-RUDDER, DEL2-DIFF  CAN' ) 
WRITE!*, 1870) 

1870  FORMAT!  6X, 'DEL3-DIFF  STAB,  DEL4-DIFF  AIL,  DEL 5= D IFF  TEF') 


URITE(«, 1880) 

I860  FORMAT <6X,'DEL6  TO  9  ARE  REVERSER  VANE  PORTS' ) 

URITEC*, 1890) 

1890  F0RMAT<»0»,5X,'R0W1',11X,'R0W2',11X,'R0W3',11X,'R0W4',11X,'R0U5') 
DO  1900  1-1,9 

WRITE (*,1825)  (DXRBMAT(J, I), J-1,5) 

1900  CONTINUE 
60  TO  421 
450  CONTINUE 
END 


I'V'I  n.  I  ^  U*  U  4  PH  'J'i'L'  U'J  f'J'  J  '  L1 1 1  Y"  J  I  .'■  '  }'•  V 


/gt,stolbln 

FILE  STOLBIN  RETRIEVED 

/  **************************************************** 
***  STABILITY  DERIVATIVE  TRANSFORMATION  PROGRAM  *** 
**************************************************** 
ENTER  BODY  AXIS  (NON-DIMENSIONAL I ZED)  COEFFICIENTS 
FOR  TRANSFORMATION  TO  DIMENSIONALIZED  BODY  AXIS 
AND  TO  GENERATE  STATE  AND  INPUT  MATRICES. 

NOTE:  ALL  COEFFICIENTS  ARE  REQUESTED  WHEN  COMPUTING 
**************************************************** 
TO  TRANSFORM  ONLY  LONGITUDINAL  DATA  -  TYPE  LONG 
TO  TRANSFORM  ONLY  LATERAL-DIRECTIONAL  DATA  -  TYPE  LAT 
TO  TRANSFORM  BOTH  LONG  AND  LAT-DIR  DATA  -  TYPE  BOTH 
KEYWORD  =  long 

**************************************************** 


?  Q  (DYNAMIC  PRESSURE  -  LBS/FT**2>  =  48.06 
?  S  (WING  REFERENCE  AREA  -  FT**2>  =  608 

?  C  (WING  MEAN  AFRODYNAMIC  CORD  -  FT)  =  15.9399 

?  B  (WING  SPAN  -  FT)  =  42.7 

?  VT  (TRIM  VELOCITY  -  FT/SEC)  =  200 

?  THETA  (PITCH  ANGLE  -  DEGS)  =  11.5840 
?  W  (WEIGHT  -  LBS)  =  33576 
?  INERTIAS  MUST  BE  INPUT  IN  BODY  AXIS. 

?  IXX  (SLUG-FT**2 )  =  23634 

?  IYY  (SLUG-FT**2 )  =  181837 

?  IZZ  (SLUG-FT**2 )  =  199674 

?  IXZ  (SLUG-FT**2)  =  -3086 

?  **************************************************** 


Q 

S 

C 

B 

VT 


AIRCRAFT  PARAMETERS 

(DYNAMIC  PRESSURE  -  LBS/FT**2>  =  48.0600 

(WING  REFERENCE  AREA  -  FT**2)  =  608.000 

MEAN  AERODYNAMIC  CORD  -  FT)  =  15.9399 

SPAN  -  FT)  =  42.7000 


(WING 

(WING 

(TRIM 


THETA  = 


VELOCITY 
1 1.5840 


W  (WEIGHT  -  LBS) 
IXX  ( SLUG-FT**2 ) 
IYY  (SLUG-FT**2 ) 
IZZ  (SLUG-FT**2 ) 
IXZ  (SLUG-FT**2 ) 


-  FT/SEC)  = 

=  33576.0 
=  23634.0 
=  181837. 
=  199674. 
=  -3086.00 


200.000 


**************************************************** 
IS  THE  ENTERED  DATA  CORRECT  ?  (YES/NO) 

?  yes 

**************************************************** 

?  ALPHA  (DEG)  =  1 1 .5840 

?  CZA  =  -.0796233 

?  CXA  =  .208763 

?  CMA  =  .931 356e-02 

?  CZQ  =  0 
?  CXQ  =  0 
?  CMQ  =  -.  169490 
?  CZU  =  . 6584 1 8e-2 
?  CXU  =  -.246580 


5 


? 

CMU  = 

-.0140683 

? 

CZH  = 

1 8 1 866e-4 

? 

CXH  = 

.681 123e-3 

? 

CMH  = 

- . 38859 le-4 

? 

CZD1 

=  - . 257 1 64e -2 

? 

CXD1 

=  -.  1 530 1 4e-2 

? 

CMD1 

=  . 57288e-2 

? 

CZD2 

=  - . 955232e-2 

? 

CXD2 

=  - . 20 1 656e -2 

? 

CMD2 

=  -. 107546e-l 

? 

CZD3 

=  - . 4888427e-2 

? 

CXD3 

=  . 1 3654 le-2 

? 

CMD3 

=  . 1 1 2899e-2 

? 

CZD4 

-  - . 45 1559e-2 

? 

CXD4 

=  . 925632e-3 

? 

CMD4 

=  -.214211e-2 

? 

CZD5 

=  . 1 35028e-2 

? 

CXD5 

=  - . 340353e-2 

? 

CMD5 

=  . 1 29075e -2 

? 

CZD6 

=  -. 135028e-2 

? 

CXD6 

=  - . 340353e-2 

? 

CMD6 

=  -. 1 376 16e-2 

? 

CZD7 

=  . 1 35028e-2 

? 

CXD7 

=  - . 340353e-2 

? 

CMD7 

=  . 1 29075e-2 

? 

CZD8 

=  -. 1 35028e-2 

? 

CXD8 

=  - . 340353e-2 

? 

CMD8 

=  -. 1 376 1 6e-2 

**************************************************** 
ALPHA  =  11.5840 

LONGITUDINAL  NON-DIM  BODY  AXIS  COEFFI CIENTS( 1 /DEG) 


CZA  = 

- . 796233E-0  1 

CMA 

= 

.931 356E-02 

CXA 

=  . 208763E-03 

CZQ  = 

0. 

CMQ 

= 

-.  169490 

CXQ 

=  0. 

CZH  = 

-. 181 866E-04 

CMH 

= 

-.388591 E-04 

CXH 

=  .681 1 23E-03 

CZU  = 

.65841 8E-02 

CMU 

= 

-. 1 40683E-01 

CXU 

=  -.246580 

CZD 1  = 

- . 257 1 64E-02 

CMD 1 

= 

.  572880E-02 

CXD 1 

=  -.  15301 4E-02 

CZD2  = 

- . 955232E-02 

CMD2 

= 

-.  1 07546E-0 1 

CXD2 

=- . 20 1 656E-02 

CZD3  = 

- . 488  427E-02 

CMD3 

= 

.  1  12899E-02 

CXD3 

=  . 1 3654 1 E-02 

CZD4  = 

- . 45 1 559E-02 

CMD4 

= 

-.21421  IE-02 

CXD4 

=  . 925632E-03 

CZD5  = 

. 1 35028E-02 

CMD5 

= 

.  1  29075E-02 

CXD5 

=-. 340353E-02 

CZD6=- 

. 1 35028E-02 

CMD6 

= 

-.  1  376 1 6E-02 

CXD6 

=  - . 34035  3E-02 

CZD7  = 

. 1 35028E-02 

CMD7 

= 

.  1 29075E-02 

CXD7 

=- . 340353E-02 

CZD8=- 

. 1 35028E-02 

CMD8 

= 

-.  1376  1 6E-02 

CXD8 

=- . 340353E-02 

**************************************************** 
IS  THE  ENTERED  DATA  CORRECT  ?  (YES/NO) 

?  yes 

**************************************************** 


LONGITUDINAL  AXIS  DIMENSIONAL  DERIVATIVES 


BODY 

AXIS 

< 1 /RAD) 

ZA  = 

-127.843 

MA  = 

l .36688 

XA  = 

.335190 

ZQ  = 

0. 

MO  = 

-.991250 

XQ  = 

0. 

ZH  = 

-. 254821E-05 

MH  = 

-. 497684E-06 

XH  = 

. 954355E-04 

ZU  = 

. 1 8  4508E-02 

MU  = 

- . 360356E-03 

XU  = 

- . 69099 1E-0 1 

ZD  1  s 

-4.12902 

MD1  = 

.840770 

XD1 

= 

-2.45679 

ZD2  = 

-15.3372 

MD2  = 

-1.57837 

XD2 

= 

-3.23779 

ZD3= 

-7.84218 

MD3  = 

. 165693 

XD3 

= 

2. 19230 

ZD4= 

-7.25022 

MD4  = 

-.314380 

XD4 

= 

1.48619 

ZD5  = 

2. 16801 

MD5  = 

. 189433 

XD5 

= 

-5.46470 

ZD6  = 

-2. 16801 

MD6  = 

-.201968 

XD6 

= 

-5.46470 

ZD7  = 

2. 16801 

MD7  = 

. 189433 

XD7 

s 

-5.46470 

ZD8  = 

-2. 16801 

MD8  = 

-.201968 

XD8 

= 

-5.46470 

★  **  **  *  **  ***  *  -kick  **  **  ***  -kirk  **  **  *  **  *  ***  *  -kirk  *  *  **  **  **  ***  ** 


1  LONGITUDNAL  STATE  MATRIXtBODY  AXIS) 


0  FOR  STATE  1 =U , STATE2=Q , STATE3=ALPHA , STATE4=THETA 


0  - .69099 1E-0 1 
0  - . 360356E-03 
0  . 922542E-05 
0  0. 


-40. 1609 
-.991250 
.979631 
1.00000 


.335190 

1.36688 

-.639215 

0. 


-31.5441 

0. 

- . 323295E-0 1 
0. 


0  LONGITUDNAL  INPUT  MATRIX 

FOR  DEL  1 =CANARD , DEL2=STAB, DEL3=TEF, DEL4=DR  AILERON 
DEL5=RT  RV,  DEL6=RB  RV,  DEL7=LT  RV,  DEL8=LB  RV 


ROW  1 

R0W2 

ROW  3 

R0W4 

2.45679 

.840770 

- . 20645  IE-01 

0. 

3.23779 

-1.57837 

- . 766859E-0 1 

0. 

2. 19230 

.  165693 

-.3921 09E-0 1 

0. 

1.48619 

-.314380 

-. 36251  IE-01 

0. 

5.46470 

.  189433 

.  1 08400E-0 1 

0. 

5.46470 

- . 201968 

-. 1 08400E-0 1 

0. 

5 . 46470 

.  189433 

.  1  08400E-0 1 

0. 

5.46470 

-.201968 

- .  1 08  400E-0 1 

0. 

**************************************************** 
IS  ANOTHER  PROGRAM  RUN  DESIRED  ?  (YES/NO) 


APPENDIX  C. 


This  appendix  presents  the  data  used  in  this  study. 

The  data  shown  has  been  reduced  via  the  program  STOLCAT 
(Appendix  E)  and  is  given  only  for  the  longitudinal  mode. 
The  original  data  from  McDonnell  Douglas  [23]  consisted  of 
a  list  of  aircraft  size,  weight,  structural  parameters,  and 
nond i mens i onal  stability  derivatives  for  linearized 
equations  of  motion.  Data  were  given  for  eight  flight 
conditions,  four  of  which  are  used  in  this  study.  The  data 
for  the  first  flight  condition,  about  which  the  controller 
is  designed,  is  listed  in  Appendix  E.  The  remaining  data 
points;  for  the  aircraft  at  sea  level,  normal  landing  gross 
weignt,  at  IOC  knots;  sea  level,  heavy  landing  gross 
weight,  at  120  knots;  and  at  10,000  feet  altitude,  normal 
gross  weight,  at  120  knots;  are  listed  respectively  in  this 


mm 


******* ;********************************************* 
AIRCRAFT  PARAMETERS 

Q  (DYNAMIC  PRESSURE  -  LBS/FT**2>  =  39.6400 

S  (WING  REFERENCE  AREA  -  FT**2>  =  608.000 

C  (WING  MEAN  AERODYNAMIC  CORD  -  FT)  =  15.9400 

B  (WING  SPAN  -  FT)  =  42.7000 

VT  (TRIM  VELOCITY  -  FT/SEC)  =  168.000 

THETA  = 


3952 


W  (WEIGHT  -  LBS)  =  33576.0 

IXX  (SLUG-FT**2 )  =  23644.0 

IYY  (SLUG-FT**2 )  =  181847. 

!ZZ  (SLUG-FT**2 )  =  199674. 

IXZ  (SLUG-FT**2 )  =  -3086.00 

**************************************************** 
ALPHA  =  17.3952 

LONGITUDINAL  NON-DIM  BODY  AXIS  COEFFICIENTS( 1 /DEG) 


CZA  = 

- .  666000E-0 1 

CMA  = 

. 8  45000E-02 

CXA  = 

. 1 68000E-0 1 

CZQ  = 

0. 

CMQ  =- 

. 177000 

CXQ  = 

0. 

CZH  = 

-.21 1 000E-03 

CMH  = 

. 200000E-03 

CXH  = 

. 1 03000E-02 

CZU  = 

-1 .47000 

CMU  = 

. 86  4000E-0 1 

CXU  = 

. 438000E-0 1 

CZD 1  = 

- . 4080C0E-02 

CMD 1  = 

. 6 1 5000E-02 

CXD 1  =- 

. 1 3 1 000E-02 

CZD2  = 

-.  1  1  4000E-0 1 

CMD2  = 

-. 1 14000E-01 

CXD2  = 

. 1 59700E-03 

CZD3= 

-.561 000E-02 

CMD3= 

. 431 000E-03 

CXD3= 

.  176000E-02 

CZD  4  = 

- . 409000E-02 

CMD4  = 

- . 1 42000E-02 

CXD4= 

.  1  28000E-02 

CZD5  = 

. 290000E-02 

CMD5  = 

. 28  4000E-02 

CXD5=- 

. 420000E-02 

CZD6  = 

-. 1 57000E-02 

CMD6  = 

- . 242000E-02 

CXD6  =  - 

. 488000E-02 

CZD7  = 

. 290000E-02 

CMD7  = 

. 384000E-02 

CXD7=- 

. 420000E-02 

CZD8* 

1 57000E-02 

CMD8* 

- . 242000E-02 

CXD8  =  - 

. 488000E-02 

**************************************************** 
1  LONGITUDNAL  STATE  MATRIX(BODY  AXIS) 

FOR  STATE1 =U,STATE2=Q, STATE3= ALPHA, STATE 4 =THETA 


. 1 20520E-0 1 

50.2254 

22 . 2483 

-30.7273 

. 2 1 7297E-02 

1 .01640 

1 . 02282 

0. 

- . 2  40765E-02 

954265 

.52499  1 

- . 57  3008E- 

0. 

1 . 00000 

0. 

0. 

0  LONGITUDNAL 

INPUT  MATRIX 

FOR  DEL  1 =CANARD 

,DEL2=STAB,DEL3 

=TEF, DEL4=DR  AILERON 

DEL5=RT  RV, 

DEL6  =RB  RV,  DEL7  =  LT  RV,  DEL8 

=  LB  RV 

ROW  1 

ROW  2 

R0W3 

R0W4 

-1 .73483 

.744418 

- . 3216 16E-01 

0. 

.211491 

-  1 . 37990 

- . 898633E-01 

0. 

2 . 33077 

. 52 1 698E-0  l 

- . 442222E-0 l 

0. 

1.6951  1 

-. 171882 

-. 322404E-01 

0. 

-5.56207 

. 343764 

. 2  28600E-0 1 

0. 

-6.46259 

- . 292926 

-. 1 23759E-0 l 

0. 

-5.56207 

. 464808 

. 228600E-0 1 

0. 

-6.46259 

-.292926 

-. 1 23759E-0 1 

0. 

.vS-.v.  v .  A .m  Aav  as:.!.  \ .  k-.uva 


**************************************************** 

AIRCRAFT  PARAMETERS 

Q  (DYNAMIC  PRESSURE  -  LBS/FT**2)  =  48.8700 

S  (WING  REFERENCE  AREA  -  FT**2>  =  608.000 

C  (WING  MEAN  AERODYNAMIC  CORD  -  FT)  =  15.9390 

B  (WING  SPAN  -  FT)  =  42.7000 

VT  (TRIM  VELOCITY  -  FT/SEC)  =  201.100 

THETA  =  15.4400 

W  (WEIGHT  -  LBS)  =  435  1  1.0 

IXX  (SLUG-FT**2)  =  35215.0 

IYY  (SLUG-FT**2)  =  190800. 

IZZ  (SLUG-FT**2>  =  219105. 

IXZ  (SLUG-FT**2 )  =  -2881.00 

**************************************************** 
ALPHA  =  15.4400 

LONGITUDINAL  NON-DIM  BODY  AXIS  COEFFICIENTS( 1 /DEG) 


CZA  = 

- .  784900E-0 1 

CMA  = 

.  957  400E-02 

CXA  = 

.  150900E-02 

CZQ  = 

0. 

CMQ  = 

- .  169000 

CXQ  = 

0. 

CZH  = 

-.  167600E-03 

CMH  = 

.  176600E-03 

CXH  = 

. 666200E-03 

CZU  = 

-  1.06500 

CMU  = 

.  639400E-01 

CXU  =- 

. 6 1 9300E-02 

CZD 1  = 

- . 263600E-02 

CMD 1  * 

.  557600E-02 

CXD 1 =- 

. 155200E-02 

CZD2  = 

-.831 500E-02 

CMD2  = 

-. 1 02000E-0 1 

CXD2=- 

. 27  4900E-03 

CZD  3  = 

- . 559 1 00E-02 

CMD3= 

.852 100E-03 

CXD3  = 

. 1 15700E-02 

CZD  4= 

- . 450800E-02 

CMD4= 

-.211 100E-02 

CXD4= 

.9421 00E-03 

CZD5  = 

. 1 89600E-02 

CMD5  = 

.  255400E-02 

CXD5=- 

. 3 1 2000E-02 

CZD6  = 

- . 742200E-03 

CMD6- 

-. 1 30 1 00E-02 

CXD6=- 

. 359500E-02 

CZD7  = 

. 1 89600E-02 

CMD7  * 

.  255400E-02 

CXD7=- 

. 3 1 2000E-02 

CZD8  = 

- . 742200E-03 

CMD8* 

-.  130100E-02 

CXD8=- 

. 359500E-02 

**************************************************** 


1  LONGITUDNAL  STATE  MATRIX(BODY  AXIS) 


0  FOR  STATE1=U,STATE2=Q,STATE3=ALPHA,STATE4=THETA 


- 

. 1 35432E-02 

-53.5387 

1.90114 

-31 .0379 

. 157841E-02 

-  .  952482 

1.36158 

0. 

- 

.11531 3E-02 

.963910 

.49  1731 

- . 426284E 

0. 

1 . 00000 

0. 

0  . 

0 

LONGITUDNAL 

INPUT  MATRIX 

FOR  DEL  1 =CANARD 

,  DEL2  =STAB , DEL3 

=TEF , DEL4=DR  AILERON 

DEL5=RT  RV, 

DEL6  =  RB  RV,  DEL7  =  LT  RV,  DEL8 

=  LB  RV 

0 

ROW  1 

R0W2 

R0W3 

R0W4 

-1 .95532 

.793002 

-.1651 42E-01 

0. 

- . 346338 

-  1 . 4506  1 

- .520925E-01 

0. 

1 . 45767 

.121183 

-. 350270E-01 

0. 

l . 18692 

- . 300220 

- . 282421 E-Ol 

0. 

-3.93079 

. 363222 

. 1 1 8782E-0 1 

0. 

-4.52923 

-.  185024 

- . 464980E-02 

0. 

-3.93079 

. 363222 

. 1 1 8782E-0 1 

0. 

-4.52923 

-. 185024 

- . 464980E-02 

0. 

ft.  .  l  -  W 
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**************************************************** 
AIRCRAFT  PARAMETERS 

Q  (DYNAMIC  PRESSURE  -  LBS/FT**2>  =  35.1200 

S  (WING  REFERENCE  AREA  -  FT**2)  =  608.000 

C  (WING  MEAN  AERODYNAMIC  CORD  -  FT)  =  15.9400 

B  (WING  SPAN  -  FT)  =  42.7000 

VT  (TRIM  VELOCITY  -  FT/SEC)  =  200.000 

THETA  =  16.4279 


w  (WEIGHT  -  LBS) 

= 

33576.0 

I XX 

(SLUG-FT**2> 

= 

23644.0 

IYY 

(SLUG-FT**2 ) 

= 

181847. 

IZZ 

(SLUG-FT**2) 

= 

199674. 

IXZ 

(SLUG-FT**2 ) 

= 

-3086 

.00 

**************************************************** 

ALPHA 

=  16 . 

4279 

LONGITUDINAL 

NON-DIM 

BODY  AXIS  COEFFICIENTS( 1 /DEG) 

CZA  = 

- .  687596E-0 1 

CMA  = 

. 706499E-02 

CXA  = 

. 1 79080E-0 1 

CZQ  = 

0. 

CMQ  = 

-.  176840 

CXQ  = 

0. 

CZH  = 

-.21  2076E-03 

CMH  = 

. 1 8  4559E-03 

CXH  = 

. 1 16490E-02 

CZU  = 

-1.43120 

CMU  = 

. 623987E-01 

CXU  = 

. 49 1 830E-0 1 

CZD 1  = 

- .  4 17763E-02 

CMD 1  = 

. 606027E-02 

CXD  1  =- 

. 126310E-02 

CZD2  = 

1  15909E-01 

CMD2  = 

-. 1 14406E-01 

CXD2=- 

. 395643E-03 

CZD3  = 

- .  553756E-02 

CMD3  = 

. 675633E-03 

CXD3  = 

. 172800E-02 

CZD  4  = 

-.4221 13E-02 

CMD4= 

-. 1 57480E-02 

CXD4  = 

. 1 24458E-02 

CZD5  = 

.  245366E-02 

CMD5  = 

. 319344E-02 

CXD5  = 

0. 

CZD6  = 

-.  161 307E-02 

CMD6  = 

-. 231230E-02 

CXD6=- 

. 354056E-02 

CZD7  = 

.  245366E-02 

CMD7  = 

. 3 1 9344E-02 

CXD7=- 

.3001 15E-02 

CZD8  = 

-.  1 6  l  307E-02 

CMD8  = 

- . 231 298E-02 

CXD8=- 

. 354056E-02 

**************************************************** 
1  LONGITUDNAL  STATE  MATRIX(B0DY  AXIS) 


0  FOR  STATE l =U , STATE2=Q, STATE 3= ALPHA , STATE 4  =  THETA 


100716E-01 

-56.5617 

21.0114 

-30.8855 

1 16793E-02 

-  .755739 

.757660 

0. 

. 1 46540E-02 

.959176 

- . 403377 

- . 455322 

0  . 

1 . 00000 

0. 

0. 

LONGITUDNAL 

INPUT  MATRIX 

FOR  DEL  1 =CANARD 

,DEL2=STAB,DEL3 

=TEF , DEL4=DR  AILERON 

DEL5=RT  RV, 

DEL6  =  RB  RV,  DEL7 =LT  RV,  DEL8 

=  LB  RV 

ROW  1 

R0W2 

ROWS 

R0W4 

-1 .48199 

.649912 

- . 245080E-0 1 

0. 

-.464206 

-1 .2269  1 

- . 679978E-0 l 

0. 

2.02746 

.  724559E-0 1 

-. 324860E-01 

0. 

1 . 46026 

-.  168884 

-. 247632E-01 

0. 

0. 

.342469 

. 1 43943E-0 1 

0. 

-4. 15413 

-.247974 

- . 946304E-02 

0. 

-3.52124 

. 342469 

. 1 43943E-0 1 

0. 

-4. 15413 

- .248047 

- . 946304E-02 

0. 

1 
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APPENDIX  D.  FOUR-INPUT/FOUR-OUPUT  MODEL 


D- 1  Introduct ion 

The  controller  designed  in  the  main  body  of  this  study 
is  for  a  three- Input/three-output  system.  This  has  been 
done  so  the  results  would  be  directly  comparible  to  the 
results  of  similar  design  efforts  done  via  the  Porter 
method  11],  As  this  Is  not  a  limitation  of  the  design 
procedure,  an  example  of  a  higher  dimension  system  is  given 
in  this  appendix.  It  should  be  noted  that  this  controller 
was  designed  in  one  CGTPIF  session  and  that  it  was  not 
possible  to  evaluate  the  controller  with  ODEF15,  as  that 
software  could  not  be  easily  modified  for  the  increase  in 
dimensions.  Therefore,  only  a  time  history  of  the  output 
variables  and  the  control  inputs  (from  CGTPIF)  are 
presented . 


D-2  The  Design  Set  Up 

For  the  purposes  of  tins  design,  it  was  decided  to 
use  the  flaps  and  aileron,  decoupled  from  the  canard,  as 
the  additional  input,  and  angle  of  attack  as  the  additional 
output.  As  a  result  the  A  matrix  of  Equation  (4-3)  is 
unchanged,  but  the  control  input  matrix  becomes: 


-2.45679  -3.23779  2.58234 


■2  1  .8588 


-.84077  -1.57837  -.231534  -.02507 

-.020645  -.0766859  -.055866  0 


(D-l ) 


and  the  associated  output  matrix  Is: 


<  D-2  ) 


All  other  design  model  matrices  remain  as  in  Chapter  4. 
The  implicit  model  becomes 

f  - .  05  0  0  0  1 


-.05 


<  D-  3 ) 


with  the  Bm,  Cm,  and  Dm  matrices  still  zero.  The  Am  matrix 
is  the  same  as  seen  in  Equation  (5-9)  with  angle  of  attack 
inserted  as  the  third  state  and  flight  path  angle  now  the 
fourth  state.  The  implicit  weightings  were  extrapolated 
from  the  three-input/  three-output  model  and,  after  a  very 
few  iterations,  were  finalized  at  1:1: 1:4  for  the  output 
derivatives  of  the  velocity,  pitch  rate,  angle  of  at  tael: , 
and  flight  path  angle,  respectively;  and  ?. :  2 :  2 :  1  for  the 
pseudocontrol  rates  for  the  canard ,  stabilator,  flap/ 
aileron  combination,  and  reverser  vanes,  in  that  order. 

The  only  change  to  the  explicit  model  is  that  the  Cm  matrix 
is  now  the  four  by  four  matrix: 


= 


(D-4) 


which  has  the  same  characteristics  as  Cm  of  Equation 
(4-13)  . 


The  truth  model  changes  in  that  the  actuator  dynamics 
of  the  flap/aileron  combination  are  now  added  to  the  At 
matrix  (Equation  4-16),  Increasing  that  to  an  eleven  by 
eleven  matrix,  with  a  proportionate  Increase  in  the 
dimensions  of  the  other  truth  model  matrices. 


D-3  Final  Controller  for  the  Four- lnput/Four-output  System 
After  a  very  few  Iterations  through  CGTPIF,  the 
following  gain  matrices  were  developed  for  the  four-input/ 
four-output  system. 


.01184 

-10.41 

95.65 

-.2047 

-.003348 

-9.706 

-2.068 

-.1432 

-.006805 

22.27 

-396.6 

.5563 

-3.401 

5 . 446 

-57.84 

.1119 

.00:8  3 1 5 

-3.6  > 

1  .53  1 

** . 2615 

.  003  3 1 3 

-  .  3  6  l  5 

-  1 . 04  3 

-  1  '>  o  •*> 

l  .  O  -J 

. 00 : 030 

0.04? 

-7 . 304 

^  n  j 

-  .03  33  3 

1  .573 

- .9434 

.  1  275 

K 


xm  = 


.01 1649 

-17.2 

.04566 

- .01594 

-.003493 

-9.778 

-.1395 

-.009605 

-.006351 

43.09 

-.1513 

.036301 

-3.404 

6.826 

-1.443 

.006357 
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•J 


I 

-.0093608 
-.0063333 
.018368 
.0037175 


( D-8 ) 


j 


1 

p 

■* 

f 

* 

f 

* 


K 


The  time-response  for  this  controller  can  be  seen  in 
Figures  D-l  and  D-2.  This  response  is  similar  to  those  for 
the  three- input/three-output  system  (Figs.  5-7  and  5-8), 
but  the  overshoot  is  slightly  smaller.  The  advantage  to 
having  control  over  an  additional  input  and  output  is  that 
one  may  exert  tighter  control  over  the  system  and  also 
independent  control  over  more  separate  channels 
(variables),  so  that  compromises  in  overall  performance 
(and  robustness)  ought  to  be  less  severe.  One  must  also 
take  into  account  the  additional  computation  time  involved 
with  the  higher  dimensionality  and  the  trade-offs  between 
accuracy  and  computation  time  must  be  considered. 
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FINAL  4-INPUT/ 4 -OUTPUT  CONTROLLER 
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Output  Variables  for  a  Four-Input/  Four- 
Output  System  (1)  Velocity  (fps>  (2)  Pitch 
Rate  (rad/sec)  (3)  Flight  Path  Angle  (rad) 


FINAL  4-INPUT/4-0UTPUT  CONTROLLER 
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Control  Deflections  for  a  Four 
Output  Systea  (i)  Canard  (2) 
Reverser  Vanes  (radians) 


-Input/  Four- 
Stabllator  (3) 


APPENDIX  E.  ACTUATOR  COMBINATION  AND  ORDER  REDUCTION 


E- 1  Introduct Ion 

This  appendix  considers  the  actuators  of  the  STOL  F-15. 
There  are  two  main  concerns  with  the  actuators  in  this 
study.  First,  as  there  are  more  system  inputs  than 
outputs,  and  as  CGTPIF  requles  these  to  be  equal,  a  number 
of  Inputs  must  either  be  combined,  excluded  from 
consideration,  or  the  number  of  outputs  to  be  controlled 
could  be  Increased  to  match  the  number  of  inputs  available. 
This  last  alternative  was  not  considered  for  the  majority 
of  this  study  to  keep  the  results  comparable  with  those 
achieved  using  other  design  methods  11,71.  For  this  study 
it  was  decided  to  combine  the  canard  with  the  flaps  and  the 
aileron  rather  than  delete  the  inputs  from  the  latter  two. 
Secondly,  the  dynamics  of  the  actuators  must  be  taken  into 
account  in  any  evaluation,  if  not  the  design,  of  a  control 
law.  An  examination  of  possible  reduction  of  the  order  of 
these  dynamics  is  also  considered  in  this  appendix. 

E  -  Combination  of  Actuators. 

Each  control  surface  contributes  a  given  amount  to 
the  generation  of  moments  about  the  aircraft  center  of 
gravity.  If  the  contribution  of  a  surface  is  neglected, 
the  controller  designed,  or  evaluated,  is  suboptimal.  For 
the  purpose  of  this  study,  rather  than  delete  the  Inputs 
for  the  flaps  and  ailerons,  the  effects  of  these  control 
surfaces  will  be  combined  with  the  canard.  To  accomplish 


this  combination,  two  factors  are  considered,  position  and 
rate  limits,  in  scaling  the  contribution  of  each  surface  to 
the  combined  input.  In  this  case  the  rate  limit  for  the 
canard,  23  degrees  per  second,  is  by  far  the  more 
restrictive  limit.  For  position  limits,  it  is  desired  that 
an  input  that  would  saturate  a  control  surface  would 
saturate  all  of  the  combined  surfaces  simultaneously.  To 
accomplish  this,  the  contribution  of  each  surface  is 
weighted  as  to  the  minimum  distance  it  can  travel  before 
saturating.  For  the  canard / f lap/a i leron  combination  of  the 
STOL  F-15,  the  ratio  for  these  inputs  is  1  :. 16667:. 5.  The 
terms  of  the  control  input  matrix  (see  data  listing  in 
Appendix  A)  for  each  of  the  appropriate  control  surfaces  is 
multiplied  by  the  given  weight,  the  products  are  then  added 
together,  and  the  resulting  sum  is  then  inserted  into  the 
first  row  of  the  B  matrix.  The  resulting  control  input 
matrix  is  shown  in  Equation  (4-4). 

E- 3  Order  Peduction  of  Actuator  Dynamic' 

The  original  actuator  models  for  the  stab i la  tor  and 
canard,  as  provided  by  McDonnell  Douglas  1231,  are  third 
order  with  a  real  pole  at  -30.62  and  a  complex  pair  at 
-138.63  +  j  235.06.  To  reduce  the  order  of  the  actuator 
model  to  second  order,  frequency  domain  analysis 
is  performed  on  the  third  order  model  and  a  proposed  second 
order  replacement  is  generated.  Figure  E- 1  demonstrates 
that  the  reduced  order  model  has  the  same  low  frequency 
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characteristics  as  the  third  order  model  and  that  it  is  not 
until  the  high  frequency  band  that  the  models  show  widely 
differing  responses  and  these  high  frequency  effects  can 
be  neglected  as  being  outside  the  bandwidth  of  interest. 
Therefore,  the  second  order  model  is  assumed  to  be  a  proper 
substitute  for  the  stabllator  and  the  canard  actuators. 

This  reduced  order  model  is  used  to  ease  computational 
loading  for  designs  that  include  actuator  dynamics  in  the 
design  model,  which  is  not  the  case  in  this  study,  or  to 
reduce  the  order  of  the  truth  model  used  for  controller 
evaluation,  once  again  for  computation  efficiency. 
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